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The present invention relates to tuning compensation parameters in a motion 
control system, and, more particularly, in one embodiment, to a method and apparatus 
which iteratively tunes a parameter which compensates for time-shift relationships in 
a motion control system. 

BACKGROUND OF THE INVENTION 

Traditional machine tool position control systems are designed with feedback 
control in which "following error" (the difference between the actual and desired 
positions) produces a command which is delivered to a velocity control loop for 
driving an actuator connected to a movable member. The actuator and/or connected 
movable member are sometimes referred to as an "axis" of the machine tool or device 
having the movable member. In practice, it is difficult, if not impossible, to achieve 
zero following error during motion of the axis if only feedback control is utilized. 
Following errors generally do not cause a problem in the case of machining long 
linear spans, because the following error vector is along the desired straight line path, 
and, accordingly, the machine path follows the desired path. However, in the case of 
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cut direction changes or in complex contouring, following errors can cause the 
machined path to deviate from the desired path resulting in a "contour error." 

Typically, the magnitude of the contour error increases as the feedrate and/or 
path curvature increases. In addition to following errors, disturbance forces, such as 
5 Coulomb friction, may also cause the machine to deviate from the desired path. 

Accordingly, "feedforward" control was developed to attempt to minimize 
following errors and errors caused by disturbance forces. Feedforward control 
attempts to minimize the following errors and to compensate "in advance" for the 
errors caused by known disturbance forces by anticipating the response of the machine 
10 tool system. The required information to allow feedforward to anticipate in advance 
is obtained by performing measurements of machine state variables while the machine 
pi undergoes various controlled movements, and/or a theoretical analysis from 

fr^ knowledge of system components, and geometries (e.g., system inertia). Feedforward 

CI compensation involves applying additional control signals, such as additional torque 

ipj 15 or velocity commands for example, based upon this knowledge of the system 
* dynamics, rather than waiting for feedback errors to build up, as occurs in feedback 

flJ control. Feedforward is used in addition to feedback, because feedback is still 

^rl required to account for imperfections in the feedforward system model, and to covmter 

Q unexpected forces, such as cutting forces. 

20 It has been known that, for optimum performance, a number of feedforward 

compensations should be utilized. For example, a velocity feedforward compensation 
can be utilized to compensate for velocity feedback control dynamics, and an 
acceleration feedforward compensation can be utilized to compensate for inertial 
forces. In addition, a viscous friction feedforward compensation can be applied to 
25 compensate for viscous friction forces, a Coulomb friction feedforward compensation 
can be applied to compensate for Coulomb friction forces, and a constant offset 
feedforward compensation can be applied to compensate for gravitational forces. 

In discrete time systems (i.e. sampled data systems), the feedforward command 
values can be generated at each update interval. The feedforward command values 
30 can then be added to the velocity command' and/or torque commands, and the servo 
can hold these signals constant over the update interval. 
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Previously, many feedforward compensation levels had to be determined 
manually. For example, to determine a Coulomb friction feedforward gain, the axis 
could be moved in a positive direction at a constant velocity and then moved in the 
negative direction at a constant velocity. Motor current measurements could be taken 
during these movements, and the measurements used to manually calculate a 
Coulomb friction feedforward gain. To determine an acceleration feedforward gain, 
the inertia level of each pertinent mechanical element in the system could be 
calculated individually, and the sum of these values used to determine an appropriate 
acceleration feedforward gain. 

As can be understood, such manual calculations had a number of 
disadvantages. For example, manual tuning took a considerable amount of time, and 
often provided less than accurate estimates. Moreover, the manual tuning of 
feedforward gains required an engineer or technician with sufficient knowledge of the 
control system and the required calculations. In addition, there was not a reliable way 
of determining whether the model developed from the manual calculations accurately 
described the actual system dynamics. Furthermore, when test movements and 
measurements were used, such as when deriving a Coulomb friction gain, there was 
no way of determining whether the test sufficiently "excited" the axis by moving it 
through enough modes of operation (e.g., enough different velocities, accelerations, 
and position changes.) In addition, such manual testing procedures did not provide a 
way of automatically determining an optimum excitation program (i.e., test motion) 
for the axis based upon user-enterable operating parameters. 

U.S. Patent No. 5,684,375, which issued to Chaffee, discloses a method for 
tuning gains in electronic motion control systems. According to the patent, the motor 
is commanded through a single, unidirectional motion event for tuning these 
parameters. As disclosed in the patent, the event comprises driving the motor at a 
predetermined tuning torque level imtil the motor reaches a predetermined maximum 
velocity, and then decelerating the motor back to zero at the tuning torque level. FIG. 
5 and FIG. 6 of Chaffee illustrate the control signals generated and the velocity profile 
of the motor during this tuning motion. During the motion, feedback signals from the 
motor are monitored and parameters, such as the electrical current applied to the 
motor, the velocity of the motor, and the acceleration and deceleration times are 



recorded. The patent discloses that a number of values can be calculated based upon 
the parameters measured and recorded, such as the effective inertia value Jm, the 
position feedback error proportional gain Kp(pos), the velocity feedback error 
proportional gain Kp(vei), the position feedback error integral gain Ki(pos), and the 
velocity feedback error integral gain Ki(vei). The feedforward gain Kff, on the other 
hand, is apparently not tuned, as the patent discloses that it can be set either to unity or 
to zero, depending on whether feedforward is to be applied. 

U.S. Patent 5,159,254, which issued to Teshima, discloses a method of 
estimating mass, inertia, viscous friction coefficient, or sliding frictional force of a 
movable part in a machine, by using a spring mass system as a model for the dynamic 
characteristic of the movable part. According to the reference, the following equation 
is used to represent the relationship between jc/. (which indicates a value obtained by 
converting an angular value of a motor shaft into a traveling direction of the movable 
part), and xj, (which indicates a position of the movable part): 

K(X2-Xi) = wV2 + CX2+> (ifX2 > 0) 
K(X2-Xi) = mX2 + (ifx2 < 0) 

where X2 is the velocity of the movable part, X2 is the acceleration of the movable part, 
m is the mass, c is the viscous friction coefficient, and> is the sliding frictional force 
of the movable part, respectively. These equations are then converted to an equation 
relating the motor current feedback value to the velocity and acceleration of the 
movable part, to obtain the mass m, viscous friction coefficient c, and Coulomb 
frictional force fr. The patent discloses that inertia is calculated by equation (4) of the 
reference which relates maximxmi current feedback value Imaxat the time of 
acceleration to the inertia (Ji + Jm). The reference mentions that the mass, viscous 
friction coefficient, and sliding frictional force can then be used to automatically 
adjust the acceleration/deceleration time constants, the position feedback loop gain of 
the servo controller, for the purposes of avoiding motor current saturation. However, 
the derivation of feedforward parameters does not appear to be disclosed, nor does the 
reference disclose the computation of any confidence factors for indicating the 
accuracy of the derived parameters. Also, the reference does not appear to disclose 
the need for predetermined motion for computing the values, or any method of 
computing such a motion. 



SUMMARY OF THE INVENTION 

Accordingly, the present invention is directed to tuning compensation 
parameters in a motion control system. 

In one embodiment, the invention is directed to a method for tuning a 
feedforward compensation parameter in a motion control system. According to one 
such embodiment, the method includes the acts of determining an initial value of a 
feedforward compensation parameter and commanding an initial movement of an 
actuator according to a test motion routine (wherein the initial value of the parameter 
is used in the control of the actuator). Error associated with the initial movement is 
determined. 

A potential value of the feedforward compensation parameter is determined. 
A movement of the actuator is commanded according to the test motion routine 
(wherein the potential value of the parameter is used in the control of the actuator) and 
error associated with the movement is determined. The errors associated with the 
movements are compared and, based on the act of comparing the errors, one of the 
values is selected as a current best value. In a further embodiment, such acts are 
repeated until the current best value is an optimum value. 

In another embodiment of the invention, a method for tuning a compensation 
parameter in a motion control system having an actuator is provided, wherein the 
motion control system utilizes a position command and a feedforward command to 
control motion of the actuator, and the compensation parameter compensates for time- 
shift relationships in the system. According to one such method, an initial value of 
the compensation parameter is determined and an initial movement of an actuator is 
commanded according to a test motion routine (wherein the initial value of the 
parameter is used in the control of the actuator). Error associated with the initial 
movement is determined. 

A potential value of the parameter is determined. A movement of the actuator 
is commanded according to the test motion routine (wherein the potential value of the 
parameter is used in the control of the actuator). Error associated with the 
commanded movement is determined. The errors associated with the movements are 
compared and, based on the act of comparing the errors, one of the values is selected 




as a current best value. In a further embodiment, such acts are repeated until the 
current best value is an optimum value. 

. Yet another embodiment of the present invention relates to a motion control 
V/system. Such a motion control system might include a position command generator, a 
feedforward command generator, a controls jr, and a feedforward tuning unit. The 
position command generator can be adapted to produce position commands. The 
feedforward command generator can be ada Died to produce feedforward commands 
based upon feedforward compensation parameters. One of the feedforward 
compensation parameters might include a time-shift compensation parameter that 
10 compensates for time-shift relationships in the system. The controller can be adapted 



C3 to commxmicate with an actuator, the positiojn command generator, and the 

|I[p feedforward command generator. The contP )ller can also be adapted to control the 

motion of the actuator based upon the position commands and feedforward 



W commands. 

S : 

^ 15 The feedforward timing unit can be adapted to determine an initial value of the 

time-shift compensation parameter, cause the position command generator to produce 
h« position commands according to a test motion routine (wherein the initial value of the 

i;v time-shift compensation parameter is used in the control of the actuator and the 

^"^'^ actviator undergoes an initial movement), and determine error associated with the 

20 initial movement. The feedforward tuning unit can also be adapted to determine a 

potential value of the time-shift compensation parameter, cause the position command 
generator to produce position commands iaccording to the test motion routine (wherein 
the potential value of the time-shift compensation parameter is used in the control of 
the actuator and the actuator undergoes movement), determine error associated with 
25 the movement (wherein the potential value was used in the control of the actuator), 
compare the errors associated with the movements, select one of the values as a 
current best value based on the comparison, and, in a further embodiment, repeat these 
actions until the ciurent best value is an optimum value. 

These and additional advantages and novel features of the present invention 
30 will become apparent to those skilled in the art from the following detailed 

description, which is simply, by way of illustration, various modes contemplated for 
carrying out the invention. As will be realized, the invention is capable of other 
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different aspects, all without departing from the invention. Accordingly, the 
specification is intended to be illustrative in nature and not restrictive. 

BRIEF DESCRTPTION OF THE DRAWINGS 

While the specification concludes with claims particularly pointing out and 
distinctly claiming the invention, it is believed that the same will be better imderstood 
from the following description taken in conjunction with the accompanying drawings 
in which: 

FIG. 1 is a control system block diagram illustrating an exemplary feedforward 
system, with which the tuning method of the present invention can be utilized; 

FIG. 2 is a graph illustrating a relationship between excitation number and 
condition nvimber, according to one embodiment of the present invention; 

FIG. 3 is a flow diagram illustrating one method of operation of the tuning 
method of the present invention; 

FIG. 4 is a velocity vs. time graph, illustrating an exemplary velocity 
command profile for an excitation part program for use in tuning feedforward 
pEirameters, according to one embodiment of the present invention; 

FIG. 5 is a velocity vs. time graph, illustrating an alternative velocity 
command profile for an excitation part program according to one embodiment of the 
present invention; 

FIG. 6 is a flow diagram illustrating an exemplary method for automatically 
generating an excitation part program for use in automatically tuning feedforward 
parameters, according to one embodiment of the present invention; 

FIG. 7 is a structural block diagram schematically illustrating an exemplary 
embodiment of an automatic feedforward tuning method and apparatus according to 
one embodiment of the present invention; 

FIG. 8 is a structural block diagram schematically illustrating an alternative 
embodiment of the present invention, wherein a CNC and servo drive are interfaced 
by an analog connection, and wherein the parameters required to allow such a 
configuration are timed in accordance with one embodiment of the present invention; 

FIG. 9 is a control system block diagram illustrating the function of the PI 
compensator of the system of FIG.8; 



FIG. 10 is struccural block diagram schematically illustrating another 
embodiment of the present invention, wherein a CNC and servo drive are interfaced 
by a digital connection; 

FIG. 1 1 is a torque vs. time graph, plotting both commanded torque and 
modeled torque as a function of time, according to one aspect of the present invention 
wherein the sufficiency of the excitation program is analyzed; 

FIG. 12 is a graph indicating measured motor velocity and measured motor 
current with respect to time, the measured values being used by one embodiment of 
the present invention to automatically estimate feedforward parameters; 

FIG. 13 is a diagram illustrating an architecture which can be used in an 
embodiment of the present invention as embodied in software; and 

FIG. 14 is a finite state machine diagram, illustrating an iterative technique for 
determining an optimum parameter value according to one embodiment of the present 
invention. 

DETAILED DESCRIPTION OF EXEMPLARY EMBODIMENTS 

/. Exemplary Embodiment of Feedforward Control System 
A. Continuous Time Model 

Referring now to the drawings in detail, FIG. 1 is a block diagram illustrating a 
continuous time model of an exemplary integrated feedforward control system having 
feedforward gains which are automatically tuned, according to one aspect of the 
present invention. The figure illustrates an exemplary model for implementing 
feedforward to compensate for various system dynamics in a motion control system, 
where s in the figure represents differentiating, and 1/s represents integrating, as is 
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known in the art. The model includes compensation for Coulomb and viscous 
friction, gravitational effects, and inertial effects. The model could be implemented 
using analog circuits, and, as can be understood, concepts which apply to this 
embodiment are discussed for further understanding of the invention, as these 
concepts may be applicable to other embodiments discussed herein. Also, it should be 
understood that while concepts are often discussed herein in the context of machine 
tool systems, as can be understood, they have application to a wide variety of motion 
control systems. 

According to this embodiment, the position conmiand is applied to a 
summing junction 10 where a position loop error Pe is determined as the difference 
between the position conmiand Xc and the actual position X of the axis. The position 
loop error Pg is multiplied by the position loop gain Ky, at block 12, in order to 
implement proportional gain of the position loop and to consequently produce a 
velocity command component V^.. Then, at sununing junction 14, the velocity 
command is added with the output of a velocity feedforward function 30, and the 
actual velocity of the controlled element is subtracted to produce a velocity loop 
error Ve. 

The velocity loop error is then used in a compensator function 16 to 
produce a torque conmtiand. The compensator function 16 utilizes an estimate of the 
total apparent inertia of the motor shaft, Je, and the velocity loop proportional gain P 
to convert the velocity loop error Vg to the torque command. The total apparent 
inertia is used so that the proportional gziin P of the compensator 16 may be 
configured by the user in firequency xmits that designate the desired velocity loop 
bandwidth. As known in the art, the value for the estimated total apparent inertia Je 
can be manually configured based upon the configurations and properties of the 
various mechanical components in the system. Also, although it is desirable that the 
variable be separately configimible from the variable Ghsiertia of block 62 for 
maximum flexibility of the feedforward system, the two could be set equal to the 
same value if desired, or the same variable could be used for both. 

Then, at summing junction 18, the torque command is added to a number of 
feedforward compensation values to obtain a total torque command value. For 



example, the ou^uts of an acceleration feedforward function 32, a Coulomb friction 
feedforward function 34, and a constant offset feedforward function 38 are all added 
at summing junction 40. This sum is then added to a viscous friction feedforward 
function 36 at summing junction 42. A jerk feedforward function 39 is then added in 
at junction 44. The output of junction 44 is then added with the torque command at 
summing junction 18 to produce the feedforward-compensated total torque command. 
This total torque command is then fed to a current loop servo-controller which 
compares the actual motor current to the torque conunand and then produces a voltage 
command wWch creates the motor current via an amplifier. A model for the overall 
dyiuimics of this current loop controller is shown as block 20. 

The resulting applied motor torque (i.e, the ou^ut of block 20) is opposed by a 
variety of forces on the machine. For example, as is shown in FIG. 1, Coulomb 
friction, the sign of which (i.e., either positive or negative) is dependent upon the 
direction of the motor velocity, opposes the applied motor torque. In addition, 
viscous friction also opposes the motor torque. These two phenomena are modeled as 
blocks 50 and 52 respectively, and the sum of the two (i.e, the output of junction 28) 
is subtracted from the motor torque at junction 22. In addition, depending on the 
direction that the axis is being moved, the force of gravity can either oppose or 
supplement the motor torque. This gravitation force is modeled as block 54 and is 
added or subtracted, as appropriate, with the applied motor torque at block 22. 

The net torque produced by the motor (i.e., the ou^ut of jimction 22) affects 
the acceleration achieved by the motor. In particular, dividing the net torque by the 
total apparent inertia at the motor shaft J, results in the acceleration which is achieved. 
Integrating this value then resvdts in the motor velocity. This relationship between net 
motor torque and velocity is illustrated at block 24. Finally, the integration of the 
motor velocity provides the actual position X which is achieved by the axis. This 
relationship between motor velocity and motor position is illustrated at block 26. 
Blocks 22, 24, 26, 50, 52, and 54 represent a model of a systeni with simple 
dynamics, particularly one that does not contain any mechanical resonance effects. (It 
has been found, however, that the automatic tuning of the parameters, described 
below, is not adversely affected by the presence of mechanical resonance effects, even 



though the preferred feedforward system utilized does not provide compensation for 
these effects.) 

As noted above, in this exemplary embodiment, five feedforward functions 
contribute a component to the total torque command. (The other feedforward, 
velocity feedforward, contributes to the velocity command). In particular, as shown 
in FIG. 1, the acceleration feedforward function 32 takes the second derivative of the 
position command derived from block 60, and multiplies it by a feedforward 
inertia estimate Gbiertia of block 62 and an acceleration feedforward gain Gaff of 
block 64. Thus, the acceleration feedforward torque is preferably proportional to the 
acceleration of the position conmiand X^. 

As is also shovm in FIG. 1, the Coulomb friction feedforward 34 operates on a 
velocity estimate, from block 66, and determines the sign (positive or negative) of this 
estimate at block 68. (A method for determining a velocity estimate is disclosed in 
U.S. Patent No. 5,170,498, the entire disclosvire of which is hereby incorporated 
herein by reference.) Then, at block 70, this sign (+1 or -1) is multiplied by the 
Coulomb friction feedforward gain Gooutto obtain the Coulomb friction feedforward 
torque component to be used. Thus, Coulomb friction feedforward is preferably either 
a positive or negative constant, depending on the direction of the velocity. 

In contrast, the viscous friction feedforward 36 is preferably proportional to 
the velocity estimate. In particular, the velocity estimate, from block 66, is multiplied 
by a viscous friction feedforward gain Gyisc to obtain the viscous friction feedforward 
torque signal. 

For the constant offset feedforward, a constant value Gconst is preferably 
utilized, as shown at block 38 of FIG. 1. Thus, the constant offset feedforward torque 
component is preferably a constant value which is applied regardless of the velocity or 
acceleration. 

The fifth and final feedforward function which contiibutes to the torque 
command in the preferred embodiment of FIG. 1 is the "jerk" feedforward 39. The 
"jerk" feedforward function 39 is utilized to compensate for the current loop dynamics 
of block 20. The parameter of block 72 is an estimate of the servo-controller's 
torque loop time constant. This parameter is multiplied by the derivative of the sum 



11 



of the four other feedforwards, from block 71, as shown in FIG. 1. 

The effects of these five feedforwards in this exemplary system will now be 
examined. For illustration, if the current loop dynamics 20 are temporarily ignored, 
then the "applied torque junction" 22 and the "torque command junction" 18 become 
5 equivalent, and the jerk feedforward can be disabled by setting the time-constant % to 

zero. As can be understood from FIG. 1 , in this scenario, if the viscous friction gain 
Gvisc of the viscous friction feedforward fimction 36 matches the actual viscous 
friction B of block 52, and if the Coulomb friction gain Gcoul of the Coulomb friction 
feedforward fimction 34 matches the actual Coulomb fiiction from block 50, then 
\a these two feedforward fimctions will compensate for the losses due to the actual 

viscous and Coulomb friction phenomena experienced. As can also be understood, if 
the constant offset gain GcoNsrof the constant ofifeet feedforward fimction 38 exacUy 
j matches the gravitational force F^, then the effect of gravity is compensated. Finally, 

if the estimated inertia G^^y^is equivalent to the actual axis inertia J. and the 
acceleration feedforward gain G^is 100%, then the acceleration feedforward fimction 
32 will compensate for the actual inertia J of the system. In addition, if velocity 
feedforward is applied at a level of 100%, the velocity feedback is nulled such that the 
velocity compensator loop output is zero and the position is developed strictly fix)m 
" the torque feedforward. Accordingly, in these ideal circumstances, the transfer 
fimction from the commanded position Xc and the actual position X is 1, and the 
effects of inertia, fiiction, and gravity are perfectly compensated. 

However, because the current loop time constant is typically not zero in 
practice, the "applied torque junction" 22 is not equivalent to the "torque command 
junction" 18. This situation can be corrected by use of the "jerk feedforward" 
fimction 39, which essentially pre-filters the feedforward torque command with a 
filter which has the inverse dynamics of the current loop dynamics 20. The so-called 
"jerk feedforward" fimction 39 of FIG. 1 is equivalent to the inverse current loop 
dynamics pre-filter of equation (1) below. This model assumes that the closed current 
control loop (torque control) is reasonably modeled as a first order low pass filter. 
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However, it should be understand that jerk feedforward can be eliminated and 
good results still obtained. It is believed that this is so because the bandwidth of a 
typical current or torque control loop is normally relatively high (e.g., a bandwidth of 
around 400 Hertz is common). This frequency is well above the bandwidth of energy 
expected to be present in the position command signals and the derivatives thereof. 
Thus, the addition of jerk feedforward can become unrealizable in a digital system 
because the rate at which the feedforward is computed every major update interval is 
too low to accomplish pre-filtering to null the effect of the current loop. 

The overall insult is that, when feedforward is implemented as shown in the 
example of FIG. 1, and when the model parameters exactly match the actual system 
parameters, and if the velocity feedforward is 100% (Gvff= 1)» then the output of the 
velocity loop compensator 16 is zero. In this case, the transfer function from the 
position command Xc to the actual position X is H(s)=l . In practice, this is rarely, if 
ever, the case, because a real mechanical system contains multiple structural 
resonances in addition to many other dynamic effects such as complex frictional 
forces, disturbance forces, etc. 

Thus, in order to maintain accuracy of the exemplary system of FIG. 1, it is 
important to avoid exciting resonances. Resonant modes can be easily excited if the 
position command signal contauis a substantial amount of high frequency energy. For 
this reason, it is important that, when feedforward is applied, that the position 
command signals be as smooth as possible. In order to accomplish this, it may be 
necessary to set the interpolator's parameters for acceleration, jerk, and step velocity 
configuration parameters to values which are substantially lower than those values 
which work well in a non-feedforward environment. (As is known in the art, the step 
velocity configuration parameter limits the amount of step change which is permitted 
in an axis' velocity defined by a sequence of axis position commands, while the 
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acceleration and jerk configuration parameters set maximum allowable values for the 
second and third derivative of the position command time sequence.) 

According to one aspect of the present invention, a nvunber of the feedforward 
gain values can be automatically tuned, as discussed in further detail below in Section 
II. These gains include the Gcoul of block 70, Gvisc of block 36, Gconst of block 38, 
and Gn^RTiA of block 62. However, it is contemplated that other feedforward gains 
could be eqixally tuned by the present invention, and that the present invention could 
be utilized with a variety of feedforward systems, having a variety of configurations 
and implementations. Accordingly, the feedforward systems described herein, and the 
parameters thereof which are tuned, should be regarded as illustrative rather than 
restrictive in nature. 

B. Discrete Time Model 

The above-discussion of FIG. 1 relates to a system with an analog or 
continuous-time controller. It was shown that feedforward is able to compensate for 
the dynamics of an input-output system whose mechanical aspects are described by a 
single inertia and fiiction. The implementation of feedforward on a digital controller 
typically requires a discrete-time design, because the control action is discrete-time. 
In such an implementation, the feedforward command signals can be sMit to the 
digital servo controller via the velocity command and torque command inputs. Then, 
the digital servo can hold these signals constant ovct the major update interval, such 
as what is referred to in the art as a "BPI" (basic process interval) for example, which 
is defined by the position command updates. 

In a discrete time implementation, the system diagram of FIG. 1 is generally 
applicable, except that differentiation (i.e., the s terms of FIG. 1) needs to be 
approximated, such as by the backward difference method, and, as discussed in further 
detail below, the model can be transferred to the "z-domain" where z-domain 
equations are utilized. The actual equations used can be difference equations which 
include terms to account for axis error compensation, scaling, gear range, inertia 
adjust, acceleration feedback, and the like. 

Equation (2) below shows a preferred backward difference method for 
computing velocity feedforward, where T is the major update interval time (e.g., 3 
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milliseconds, 5 milliseconds), z ' is a backward shift by one update T, Xe(z) is the 
position command, Gyrr is the velocity feedforward gain (where 1=100%), and Vfif(z) 
is the velocity feedforward command. 

This equation can be used with conventional and digital servo-controllers to 
provide the velocity feedforward as a component of the velocity command. However, 
it should be understood that other methods of obtaining similar results could be 
utilized as well. 

A backwards difference method can also be used for obtaining acceleration 
S feedforward. In one embodiment, the acceleration feedforward command can then be 

implemented as a torque command and determined by multiplying this acceleration by 
the inertia estimate and tiie acceleration feedforward gain G^. such as is 

If II 

y. shown below as equation (3): 

U . . ^ ^ (l-zjill V (3) 
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As discussed above. Coulomb friction is a constant force which opposes 
motion. The Coulomb friction is a positive constant for positive velocities, a negative 
constant for negative velocities, and is discontinuous at zero velocities. Thus, tiie 
model used in tiiis preferred embodiment assumes tiiat tiie Coulomb friction forces 
acting on tiie axis during negative velocity motion are equal and opposite to tiie , 
Coulomb forces acting on tiie axis during positive velocity motion. In particular, a 
positive gain is added to the torque command for positive velocities, and a negative 
2 0 gain added to tiie torque command for negative velocities. 

The sign of tiie velocity of tiie position command could be used to determine if 
+GcouL should be applied or if -Gcoul should be applied as tiie Coulomb friction 
feedforward. However, in certain sitiiations. it may be desirable tiiat velocity and 
acceleration feedforward are temporarily disabled, while Coulomb friction 
feedforward is still desired. In such situations, tiie sensed velocity of tiie axis will lag 
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the derivative (i.e., velocity) of the position command signal. However, the step 
change in Coulomb friction feedforward should take place at the instant when the axis 
actueilly reverses direction and not when the velocity of the position command signal 
reverses. 

Accordingly, a velocity estimator can be used to produce an accurate estimate 
of the actual axis velocity (and, thus, to estimate the moment when the axis actually 
reverses direction). One preferred z-domain equation for the axis velocity estimator is 
shown below as equation (4): 



The Coulomb friction feedforward value can then be determined by 
multiplying the Coulomb friction feedforward gain Gcoul by the sign (positive or 
negative) of the velocity estimate at the current (k'th) interval update. Accordingly, 
an equation such as the following can be utilized to calculate the Coulomb friction 
feedforward as a torque command: 

T^coui^^) = G^ouiSign(V„,(^)) (5) 

In the actual implementation, it has been found that it is useful to add a small 
amount of hysteresis to the sign function to prevent inappropriate instantaneous^ 
change in friction feedforward level. 

Viscous friction feedforward can be implemented in discrete time as a torque 
command which is proportional to the estimate of the axis velocity. In particular, the 
estimate can be multiplied by the viscous friction feedforward gain Gyisc- 
Accordingly, the axis velocity estimate discussed above (equation (4))can also be used 
for viscous friction feedforward in discrete time. In particular, the following equation 
shows a preferred way to calculate the viscous friction feedforward torque command 
component, which counters frictional forces which are approximately linearly 
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proportional to axis velocity: 



Constant offtet feedforward is used to counteract torques imposed by 
gravitational fon:es and counter Wanc^. Normally, the integra«>r in tite velocty 
loop would counteract the constant offset. However, when ceruun types of non-Unear 
feedback, such as integrator gain scheduling, arc implemented, it can be benefical to 
feedforward the constant offset torque. Constant offeet feedforward allows the 
tategrator's nominal value to be near zero rather than at some level requned u> 
cotnteract a.e offee. torque. The constant offset feedforw^ is preferably set equal to 
a constant. . (the constat o^ feedforward gain). accordi« to tite foUowmg 

equation: 

(7) 

I, has been found that jerk feedforward partially negates the low pass na«« of 
.hecurr^tt control loop, and works best when the current controlloop is approxho^ 

by.firstorderlowpassfU.er. Jerk feedforward computes the first derivative of the 
sum of fl.e.o.que commands (the sum of the outputs of the acceleration feedforwaM 
flmction. the Coulomb fiidon feedforward finxcUon. the viscous «ction fc«lforward 
fi^^tion. and the constant offiet feedforward function). Even though "jerk" .s 
ac.uallythefiTS.derivativeofacc«lcration..he,em."jerkfeedforward»isused 

because a large portion of the sum of the mues comprises the first deriv«ive of the 

acceleration feedforward. * 
Jerk feedforward can be implemented in discrete time by m^ytoi the discrete 
equivalent of the term (xs.l) «. the sum of tite torque fe«lforward components. The 
term X is the time constant of ti« first order approximation of fl.e current control loop. 
In such an Unplementation. the jerk feedforwani takes the sum of ttte individual 
components of the torque command and applies a backward difference discrete ttme 
equivalent filter to the inverse of the first order model of the servo's «,rque control 
loop: 
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= (i + ^ (i-z-M){rc,,,,(z) -rc,,„,(z) *rc^^^(2) ) 



It has also been found that care should be taken when applying jerk 
feedforward because it can increase the level of high frequency energy in the torque 
command signal and make excitation of mechanical resonances more likely. 
Accordingly, the jerk feedforward can be disabled by setting t equal to zero, and it 
can later be enabled in special cases where it is found to be beneficial. 

//. Automatic Tuning of the Feedforward Gains 

According to one aspect of the present invention, several of the feedforward 
gains, discussed above with respect to the continuous and discrete time model, can be 
determined by processing data acquired while moving or testing a machine axis using 
an automatically generated part program. As discussed in further detail below, the 
excitation part program preferably moves the axis being tuned back and forth at 
various feedrates and generates a data acquisition file for the axis, the file including 
velocity feedback data and motor torque command data. (The term "feedrate" refers 
to the velocity of the point of interest, and is the vector simi of the velocities of the 
various axes moving this point. If only one axis moves the point, the feedrate is equal 
to the velocity for this axis.) 

The excitation program, also referred to as the "test program" or "test motion 
routine," can be generated automatically based upon parameters provided by the user, 
according to one aspect of the invention,;as described in detail below. The acquired 
data can then be analyzed by an automatic tuning algorithm which determines an 
optimum set of feedforward gain parameters based upon the measurements taken. 
' Capability is also provided for determining how well the derived parameters correlate 
with the actual machine tool system, as well as for determining how well the test 
program "excited" the axis. "Excitation" is the degree to which the motion causes 
each aspect of the axis dynamics to be present. 

A. The Preferred Automatic Tuning Algorithm 
1. The Equations for the Model 
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In the preferred embodiment, the auto-tuning algorithm estimates the 
feedforward parameters for an axis by using an input-output model that is meant to 
represent the behavior of the axis drive mechanisms. The model comprises a system 
whose input is the motor shaft velocity and whose output is the motor torque 
command. The model assumes that the torque delivered by the motor is equivalent to 
the torque command. In practice, there will typically be some dynamic mismatch 
between the torque command and the motor torque, but this approximation is 
expected to be reasonable for the purposes of obtaining feedforward parameters 
because the frequencies associated with torque control are much higher than those 
described by the parameters of the model. The dynamics model preferably accounts 
for the following effects (these effects could equally apply to linear motion axes, 
rotary motion axes, ballscrew and rack-and-pinion mechanical motion components, 
angular and linear velocities, and other system particulars, as can be understood). 

• Inertia - the total apparent inertia of the axis as seen at the motor shaft. 
It can be expressed in rotary units of Kg-meter* (N-M-Sec'). For a 
linear axis, the inertia can include the contributions of the motor, 
coupling, ballscrew, and linear mass. 

• Viscous Friction - the torque opposing the motion which is 
proportional to the velocity. It is sometimes associated with some type 
of fluid motion e.g. greased bearings, altiiough its effects can be 
present in many types of systems. Viscous friction can be expressed in 
rotary units: N-M/rpm. 

• Coulomb Friction - the constant friction force opposing the motion. 
The Coulomb friction can be expressed in motor-torque units of N-M. 

• Constant Offset - tiie component of tiie torque which is always applied 
independent of tiie motion. It can be caused by gravity, 
counterbalances, direction dependent Coulomb friction, tilting of the 
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machine, for example. It can be expressed in units of N-M. 

Once these values are found by using the automatic tuning method, they can 
then be used to derive the optimum feedforward gains to be used, Gaffj Gvisc^ Gcoul* 
and GcoNST5 which are described above. 

The tuning algorithm for the axis preferably utilizes Newton's Law: the sum of 
the torques applied to an object equals the angular acceleration times the object's 
moment of inertia: ET = Ja. The torques present in the preferred system model of 
FIG. 1 are the applied torque (which is proportional to the motor current), and the 
opposing torques caused by viscous friction, coxilomb friction, and gravity: 

TappHcd " Tyiscous " '^Coulomb ""Tgravity 

This concept can be applied equally to linear motors, where the sum of th 
forces is equal to mass times acceleration (TF = ma). While the remaining discussion 
is tailored toward a rotary motor application, it should be understood that the concepts 
can easily apply to linear motors as welL 

As discussed above, it is known that the torque due to viscous friction can be 
modeled as a constant times the velocity, that the torque due to Coulomb friction can 
be modeled as a constant times the sign of the velocity, and that the torque due to 
gravity can be modeled as a constant It is also known that a is the derivative of 
velocity. Accordingly, the Newton's law equation for the preferred model of FIG. 1 
can be expressed in terms of velocity: 

Where Tcmd is the torque conimand to the torque control loop (and corresponds to the 
output of junction 18 of FIG. 1), T^ is the component of torque caused by Coulomb 
friction (and corresponds to the output of block 50 of FIG. 1) V is the motor shaft 
velocity (and corresponds with the output of block 24 of FIG. 1), B is the coefiBcient 
of viscous friction (and corresponds to the output of block 52 of FIG. 1), T^onst is the 
constant offset torque (and corresponds to the output of block 54 of FIG. 1) and J is 
the total apparent inertia of the axis (and corresponds to the value J in block 24 of 
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FIG. 1). 

The tenns in the above equation which are known or directly measurable are: 

• TcMD - The digital servo-controller's total torque command to the 
torque control loop. This parameter can be captured during execution 

5 of the test program. 

• V - The digital servo-controller's measured motor velocity (RPM). 
The velocity can be captured during execution of the test program, and 
is preferably captured simultaneously with the torque command at 
discrete times. 

^ • sign(V) - Indicates whether V is a positive (+) or a negative (-) value. 

cJ! • dV/dt- The derivative ofthe motor speed. This can be approximated 
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S'l from V. 

a 

•?= 5 

Accordingly, the four terms in equation (9) which are unknown are the model 
U parameters: Tfc, B. T^, and J. Because tiiere are four unknown terms, in ordw to 

avoid an underdetermined system, it is preferred that at least four measurements of tiie 
motor feedback velocity V and the reported torque command Tcmd. are taken. This 
results in a at least four simultaneous equations which can tiien be solved for tiie four 
unknowns. Even more preferably, tiie number of measurements of velocity V and 
torque command Tcmd taken is in tiie tiiousands to tens of tiiousands. This results m an 
2 0 "overdetermined" system (more equations tiian unknowns) which increases accuracy 

and decreases tiie chance tiiat noise or bad measurements will affect tiie results, . 

The set of simultaneous equations may be represented m matrix form as shown 
below, using a common matiiematic nomenclature. In tiie following equation, tiie 
parameter t represents the time at which a measurement was taken. 



21 













V{t^) 




V{t„) 









J 




T^«r. { ) 




B 






i 










T 

fc 








T 

const 











(10) 



•SB? 

f!5 



ru 



:j e s gm 
5 



10 



15 



20 



This equation can then be rewritten using symbols to represent the matrices 
and vectors involved: 

[A]x{P} ={r^} (11) 

Techniques for solving this equation for the four unknown parameters in the 
vector {P} are discussed in detail below. The remainder of this section discusses how 
information from data acquisition can be used to construct the matrix [A] and the 
vector {TcK©}. 

In particular, the columns of matrix [A] contain sequences derived from the 
motor velocity data acquisition measurement. The first column of [A] contains the 
derivative of the motor velocity, i.e. motor acceleration. This can be derived from 
measurements of the motor velocity. The motor acceleration is approximated by 
computing the difference between the next value of motor velocity and the previoxis 
value of motor velocity, as shown in equation (12). This method is preferred over 
using the forward or backward difference between two successive velocity 
measurements because it provides a better estimate of the derivative at time t, is more 
immune to noise, and results in no pure time delay because the data is post-processed. 
It is most convenient for all rows in the matrix [A] to represent successive 
measurements in time where the time increment between measurements is the 
smallest possible, such as by using increments of the contrors basic process interval 
(BPI, e.g, 3 milliseconds or 5 milliseconds.) This time interval is designated in 
equation (12) below by the symbol t,. 
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Taking all this into consideration, it is preferred that the accelerations in th( 
first column of [A] are determined from the following equation where the velocity 
V(t) is in units of revolutions per minute, and the acceleration dV/dt is in units of 
rad/sec^: 



dt^^ 60 2 t^ 

In order to save computation time, some of the terms of this equation (e.g., 
211/60 times l/2tj can be combined into a single variable, and this variable computed 
once, rather than for every axis measurement taken. 

The second column of [A] is the motor velocity V(t) in units of rpm and is 
based on the measurements of motor feedback velocity. 

The third column of [A] can be computed by checking for the sign (positive or 
negative) of V(t). where sign(0) is preferably defined to be 1. such as according to the 
following equation: 



sign ( V( t ) ) = 



+1 , V{t)^0 (13) 
-1 , V(t) <0 



on 



The fourth colvram of [A] contains all Vs. 

Turning now to tiie vector { Tcmd } of the equation (1 1), tiiis vector is based 
the motor torque command signal reported by tiie digital servo for each velocity 
measurement taken. Thus, for each velocity that is recorded at tiie update intenwl, tiie 
commanded torque is also recorded so as to conrelate tiie two. The torque command is 
preferably in units of Newton-meters. 

2. Zero Phase Filtering of the Velocity and Torque Command 

Measurements 

In tiie previous section, it was shown how data acquisition measurements can 
be used to create tiie matrix [A] and tiie vector (Tcmd). Often, however, tiie dynamics 
of the machine tool's axis includes modes of vibration which occur at relatively high 
frequencies which are not included in tiie prefenred model described above. The 



results of these vibrations may appear as noise on the data acquisition velocity and 
torque command signals. Additionally, torque ripple from the motor and cyclic error 
from the feedback device are two sources of noise which may appear as a periodic 
signal superimposed on the torque command and motor velocity waveforms. In order 
to limit the effects of these signals on the parameter timing algorithm, it has been 
found that the data acquisition signals should undergo a process of linear digital low- 
pass filtering to remove any high frequency vibrations, torque ripples, or cyclic errors. 

The rationale for filtering the signals to remove the noise components is that 
these are non-linear disturbance inputs which are not addressed by the feedforward 
algorithm. If the filter is able to remove the efifects of nonlinearities from both the 
motor velocity and torque conunand, then the result of the estimation should 
accurately model the linear aspects of the dynamics. It is also preferred that both 
velocity and torque commands are filtered because both signals can contain noise. 

One important benefit gained by digital filtering of the torque command and 
motor velocity signals is that it prevents the high frequency content of these acquired 
signals from causing the algorithm to incorrectly indicate that the model does not 
correctly describe the linearized system. In other words, filtering prevents 
inappropriately low values of model "coherence" (coherence is described in fiirther 
detail below). It should be understood that the torque command and velocity feedback 
signals used to populate the matrices of equation (10) should be the signals after 
having undergone filtering. 

In the preferred embodunent, the high frequency content of the motor velocity 
and torque command signals are removed using a fourth-order zero-phase digital low- 
pass filter. The cutoff frequency for this filter can be fixed at a predetermined level, 
such as 150 Hertz. While other appropriate values can be utilized, this value is 
preferred because even on the highest perforaiance machines, it is not expected that 
the machine positioning system will be required to respond more quickly than 1 50 
Hertz. In general, the cutoff frequency should be high enough to not ruin signal 
content caused by inertia and fiiction. 

Identical filters should be applied to both the velocity and torque command 



because any low frequency amplitude attenuation on the velocity signal must be 
duplicated on the torque signal in order for the equations to remain valid. In other 
words, if both sides of equation (11) are acted upon by an equivalent filter, then the 
equation remains valid. 

The fourth order zero phase filter can be the product of two second order 
filters which have identical amplitude characteristics and have phase characteristics 
which are the negative of each other. Alternatively, the zero phase filter can be 
implemented by filtering the signal with a second-order causal filter and then filtering 
the filtered signal with the same second-order causal filter, but in reverse time. This 
process is shown for the example of motor velocity in the following equations. In the 
equations : v(k) is the data acquisition motor velocity at sequence number k, r is an 
intermediate variable, v(i) is the zero-phase filtered velocity, and N is the number of 
data points in the measurement. An analogous set of equations should be used to 
filter the torque command. 



r(0) = v(0) 

r\k\ = alr\k-2) *a^r{k-l) *b^vik-2) *b^vik-l) *b,v{k) , Jc = 2 , 3 , . . . , N 
»{W-1) • r(W-l) 

«j^(l+2) ♦t,rti*2) ♦fcjrCi*!) ♦l»,r(J) , i = U-2.K-3, ...,3,2,1 



The coefficients of the filter are preferably based on a second order system 
with ^=150 Hertz bandwidth and C=0.707 damping ratio. The filter coefiFicieiits can 
be derived based on a matched zero-pole mapping of a continuous time second order 
filter. 



3. Solution of the matrix equation 
a. Normal Equations 
As noted above, thousands to tens of thousands of motor velocity and motor 
torque command measurements are made during the test motion. Accordingly, matrix 
Equation (1 1) represents an overdetemiined system where, there are more equations 
than unknowns. The set of equations can be solved for the four unknowns using a 
mathematical technique known as the "least squares technique" which minimizes the 
sum of the square of the error between the modeled motor torque and the measured 
motor torque command: 



The solution for the parameter vector {P} that minimizes this quantity is the 
least squares solution. Two possible techniques for finding this solution are the 
"normal equations" technique, and "singular value decomposition." 

According to the former, the vector {P} is written using the so-called normal 
equations. 



As can be seen from equation (18), the normal equations solution requires 
inversion of the matrix [[A]'^[A]]. This matrix has the properties of being real, and 
symmetric. Because of these properties, the matrix inverse can be computed using 
Jacobi's method for finding the eigenvalues and eigenvectors of a real synunetric 
matrix. Briefly stated, Jacobi's method involves successively applying rotation 
transformations to portions of the matrix until it is diagonalized. A full explanation of 
Jacobi's method is given in "Numerical Recipes in C" by Press, Flannery, Teukolsy 



Ee^ = {[A)x{P)-{Tc«,>)'''{tA]«{P}-{T««,>l 



(17) 



{p)=[[A]'tA])-tA]'{Tj 



(18) 



and Vettering, and in "Matrix Computations, Second Edition," by Golub and Van 
Loan (Johns Hopkins Univ. Press, 1989), both of which are hereby incorporated by 
reference. The technique is guaranteed to work as long as the matrix is invertible. 

More specifically, the matrix inverse [[A]^[A]]"* is required to solve the 
normal equations. This inverse can be determined from the eigenvalues X and 
normalized eigenvectors {XJ of [A]'^[A], which can be found using Jacobi's method. 
It can be shown that the eigenvectors of a real symmetric matrix are orthogonal to 
each other. Thus the following approach can be used, where the eigenvectors {Xj} are 
normalized to have unity magnitude. 



((Al'tAj](Uj) |X,> |X,> {X,jJ-((X,| IJf,) |X,> |X,l) 



Xj 0 0 0 

0 X, 0 0 

0 0 X, 0 

0 0 0 



(19) 



Right multiplying both sides by the transpose of the matrix of eigenvectors leads to: 



X, 0 0 0 

0 X, 0 0 

0 0 X3 0 

0 0 0 X, 



(20) 



Taking the inverse of both sides of this relation provides the desired quantity. 



1/Xj 0 0 0 

0 1/Xj 0 0 

0 0 1/X, 0 

0 0 0 1/X^ 



[(Xj) (x,j ix,) (X,)]' (21) 



This quantity can then be used in equation (18) to solve for the vector {P} 

6. Singular Value Decomposition 
An alternative "least squares" solution to the normal equations technique for 
solving for {P} is to use "singular value decomposition'* One advantage of singular 



value decomposition is that it is numerically more robust (i.e., is less sensitive to 
numerical roundoff error ) than the "normal equations" solution and provides a useful 
quantity known as the matrix condition number, which is described in further detail 
below. 

Normally, singular value decomposition is a complex and expensive 
algorithm. However a much simpler approach can be used for matrices with a small 
number of columns. It can be shown that for a matrix [A] which has at least as many 
rows as colvrams, the singular values are identical to the square root of the eigenvalues 
of [A]''[A]. The eigenvalues may be obtained by Jacobi's method. 

SVD{ [A] ) = y/eig{ tA]^[A] ) i.e., = ^22) 

Further details on the singular value decomposition method can be found in 
"Numerical Recipes in C." Accordingly, the singular value decomposition technique 
and the normal equations technique are two exemplary methods which can be utilized 
for solving equation (11) for the vector {P}. The values which are found are Tr, (the 
component of torque caused by Coulomb friction) B (the coefficient of viscous 
friction), Teo,^ (the constant offset torque), and J (the total apparent inertia of the axis.) 
Accordingly, with reference to FIG. 1, Te, can be used as the gain GcoulO^ *e 
Coulomb friction feedforward fimction 34, B can be used as the gain Gyiscof the 
viscous friction feedforward function 36, can be used as the gam GcoNsxOf *e 
constant offset feedforward function 38, and J can be used to determine the gain Gaff 
of the acceleration feedforward function 32. 

With regard to the acceleration feedforward function 32 in particular, the' total 
apparent inertia J of the axis, which is automatically determined using the invention, 
can be used to set the value of the feedforward inertia estimate Ginertia- Then, the 
gain Gaff of the function 32 can be set to 100%. In other words: 



^INERTIA - (23) 

GAFF = 100% 
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The gain Gaff c^an later be tweaked as desired and/or needed. 

In an alternative embodiment, the percentage acceleration feedforward gain, 
Gaff of the acceleration feedforward function 32 can be determined by dividing the 
estimate of the actual inertia J as seen at the motor shaft, (which is automatically 
determined by solving the vector {P}), by the value "total Jnertia", which is an 
estimated inertia parameter configured for the machine based upon the configurations 
of the various mechanical components which make up the system. The total_inertia is 
comparable to the continuous time value of Je shown in FIG. 1 . 

In this alternative embodiment, if the acceleration feedforward gain, Gaff^ 
differs greatly from 1, then there was either a problem with the test, or one or more of 
the configuration values is set incorrectly. : It may. be advantageous to modify the 
totai_inertia, re-tune the velocity loop's proportional and integral gains, and re- 
perform the auto-tuning. 



4, The Condition Number and Excitation Number 
As noted above, the singular value decomposition method is preferred for 
solving equation (11) because it provides a matrix condition number. As discussed 
below, it has been found that this nxmiber can indicate how well the test program 
"excited" the axis. 

As described above, the eigenvalues, Aj, and the eigenvectors, {XJ, of [A]'^[A] 
can be found using Jacobi's method. The condition number of [A] can then be 
determined as follows. * 



condition number = C 



(24) 



Thus, the matrix condition number of the matrix is the maximum singular 
value of [A] divided by the minimum singular value of [A]. 



Mathematically, the singular values of [A] can be viewed as describing the 
contributions of the corresponding column of [A] toward the rank of [A]. In other 
words, the condition number describes the uniqueness of the columns of [A] with 
respect to each other. A condition number of 1 indicates total uniqueness. As the 
5 condition number increases, the columns are less unique. 

In terms of the present case where [A] is determined from velocity 
measurements in a machine tool system, according to one aspect of the present 
invention, it has been found that a small condition number means that the test motion 
contained enough complexity to excite all aspects of the axis. For example, in terms 
^0 of the preferred embodiment of FIG. 1 , the test program contained sufGcient changes 

Q in position, velocity, acceleration, and direction to excite the various gravity, friction, 

J[| and inertia phenomena modeled in the system diagram and included in the Newton's 

O law equation. As the condition number increases, one aspect of the axis is being 

III 

excited more than another. In the extreme case where the condition number is 
ljbL5 infinite, the test program is such that it is impossible to distinguish between two 

different aspects of the model. For example, if the machine's test motion is such that 
the axis only travels with a positive velocity, it would be impossible to distinguish 
between the Coulomb friction and the constant offset, and the condition niunber 
would be infinity. Another example is if the axis were undergoing constant 
2 0 acceleration and positive velocity during the entire measurement. In this case, it 

would be impossible to distinguish between Coulomb friction, inertia, and constant 
offset effects. 

When the condition number is large, but not infinite, the excitation is such that 
it becomes difficult to distinguish between different aspects of the axis. In the 

2 5 presence of measurement noise, a large condition nvimber indicates that a 

phenomenon due to one aspect of the model may be falsely attributed to another 
aspect of the model. This should be avoided because it can result in values for the 
feedforward parameters that can cause feedforward to be incorrectly applied. 

While a large condition number indicates that the different modes of the 

3 0 dynamics model may not have been excited equally, it can be difficult to determine 

whether the condition number is large when considering the fact that it can vary from 
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1 to infinity. For the purpose of determining the level of excitation, the largeness of 
the condition number is strictly relative. More specifically, the condition number of 
[A] depends on the units representation of each column of [A]. For example, if the 
first column of [A] contained acceleration expressed in units of rev/sec^ instead of 
rad/sec^ and the second column contained velocity expressed in rev/sec instead of 
rpm, then the condition number of [A] would change. This would not mean that the 
level of excitation had changed. 

Accordingly, it has been found that the condition number can be scaled to aid 
in the reading of the relative size of the condition number. One possibility is to scale 
the columns of [A] to change the condition number. If [A] is scaled in such a way 
that the condition number is minimized, then the condition number of the scaled 
matrix [A] would be an absolute measure of the ratio of the amount of excitation of 
the most excited mode to the amoxmt of excitation of the least excited mode. One 
alternative method of achieving scaling is to scale the columns of [A] is to scale theni 
with respect to the known axis configuration and known information about the 
excitation part program. 

The preferred approach is to scale each column of [A] such that the maximum 
value in the column would be expected to be 1 000. This can be accomplished by 
scaling the n'th column of [A] by the scaling factor C„. In particular, the first colimin 
can be scaled by a factor which is 1000 divided by the maximum expected 
acceleration of the motor based on the axis configuration data. The maximum motor 
acceleration expected to be achieved during the test (shown as "riiotor^accel" in the 
equation below) is computed automatically by the controller and saved as a constant. 



The second column of [A] can be scaled by a factor which is 1000 divided by 
the maximum expected motor velocity {motor _vmax). It can computed based on the 
maximum programmed feedrate for the excitation program. As discussed below, this 
value can be provided by the user, or automatically set by the algorithm if the user- 



^1 = 



1000 



(25) 



motor accel max 



entered parameter exceeds a certain value. 



r = (26) 

^ motor vmax 



The scaling factor for the last two colxunns can be set to 1000. 



C3 = 1000 (27) 



H = 1000 (28) 

m 

|i=fc 

When scaling the condition number using this preferred manner, the condition 
|r g number provides a better indication of how close the excitation program came to 

l"5 being able to excite each mode of the dynamic model equally and sufficiently. 

pa ^ 

iofcs ^ 

p Experimentation on a wide variety of machine tool axes has indicated that, with these 

' " preferred scaling values, a large condition number is about 10,000 or larger. Such a 

number indicates that a problem may have been encountered. For example, the test's 
setup parameters might be inappropriate, or an unexpected event may have occurred 

10 during execution of the test. Examples of this could be an incomplete data 

acquisition record due to limited buffer size, a lack of axis motion due to an axis 
inhibit or feed hold, or an incorrect or new configuration setting (e.g. axis acceleration 
rate). Other problems causing large condition numbers might be improper settings in 
the control, damaged machine components, or a change in servo feedback gain. A 

15 large condition nimiber may indicate that the data should be rejected, the cause of the 

problem determined, and the test re-administered. Alternatively, a large condition 
number may indicate that a different excitation program should be utilized. 

Scaling the columns of [A] causes a corresponding scaling of the model 
parameters contained in {P}. These scaling factors must be removed from {P} once it 



32 



is solved before the parameters of the vector {P} can be used to derive feedforward 
gains. The effect of scaling factors, Cj, on the system of equations is seen by 
rewriting equation (11) where the columns of [A] are scaled. 



q {Aj} qCAj) CjfAj) c, {A,} 



B/C, 



(29) 



From the preceding equation, it can be understood that, for a matrix [A] whose 
columns are scaled by factors Cj, the model parameters are derived from the elements 
of the parameter vector {P} using the following equations. 



In summary, scaling the matrix [A] allows for a more meaningful and easy-to- 
interpret condition number for determining the sufficiency of excitation of the axis by 
the excitation program. However, scaling the matrix [A] causes a corresponding 
scaling of the derived model parameter (J, fi, Tpc and Tconst)» and this scaling factor 
must be removed from these parameters before using them to calculate feedforward 
gains. 

In addition to scaling the matrix [A] to make the condition number easier to 
interpret, an excitation number can also be derived to further aid in interpretation of 
the level of excitation. The excitation number is a value defined to represent the same 
information as the condition number (after scaling), but is easier to interpret. The 
excitation number preferably varies from 0 to 1 where 0 indicates very poor excitation 
and 1 indicates excellent excitation. More specifically, this number is preferably a 
logarithmic function of the condition number. The excitation number can be 
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constructed such that it has a value of 0 when the condition number is unacceptably 
high and a value of 1 when the condition number is acceptably low. A preferred 
definition of the excitation number is shown below. 
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In the equation, Cnum is the condition number of the [A] matrix, CNUM_best is the 
condition number threshold which indicates completely sufficient excitation, and 
Cv„„. _ is the condition number threshold which indicates completely insufficient 
excitation. The values for Cnum,*™* and CNUM_be« can be hard coded. Based on 
empirical data, the values for these condition number thresholds are preferably 
defined as follows (when the preferred scaling fectors discussed above have been 
utilized to obtain the condition niraiber). 



r =3 
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However, additional experience with implementation of the present invention 
in particular {q>plications may reveal a requirement tiiat these values be adjusted. 
Also, tiie use of different scaling factors may necessitate a corresponding change of 

A plot of a preferred relationship between the excitation number and the 
condition number is shown in FIG. 2. As shown in tiie figure, tiie excitation number 
varies from 0 to 1.0, and is closer to 1.0 when tiie condition number is low (e.g., close 
to 1), and is closer to 0 when the condition number is high (e.g. close to 10,000). 

Accordingly, as shown above, it is contemplated tiiat a variety of metiiods 
could be utilized for scaling or adjusting tiie condition number to allow it to be better 
interpreted in terms of the sufficiency of excitation of the test part program. 

5. Computation of Model Coherence as a Confidence Factor 

According to one aspect of tiie present invention, a model coherence number 
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can be derived to serve as an indicator of how well the assumed structure for the axis 
dynamics model was able to describe the measured behavior. In other words, the 
coherence indicates how well statistically the four parameters which were found by 
solving the matrix equation (1 1) (i.e. J, B, Tpcand Tconst), relate to the measured 
behavior as recorded by the data taken. Because thousands of measurements are taken 
and the system is overdetermined, the measured torque commands will not exactly 
equal the theoretical torque commands found using the solved parameters. In other 
words, the solved parameters are analogous to an "average" which is based upon the 
thousands of data points taken. 

In the preferred embodiment, the coherence is based upon the motor torque 
command Tcmd, measured during the test excitation program, and a theoretical motor 
torque Tm- The theoretical motor torque Tm can be computed from the model by 
solving for the vector {P} as described above, and inserting the solved vector {P} into 
the following equation: 

T„ = [A] {P} (33) 

where [A] is the input matrix before scaling and {P} is the parameter vector 

with scaling removed. 

Then, the coherence can be calculated as the square of the covariance of 

TcMD and Tm, divided by the following quantity: variance of TcNa> multiplied by 

variance of T^. 

^ VARiT^) ^VARiT^^) 



The explicit computations involved in the above are given in the following 
equation, where the summation is taken over each component of the sequence and the 
overbar indicates the average value of the sequence. 
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Thus, in the preferred embodiment, the coherence is a number between 0 
and 1 .0. A coherence of 1 .0 indicates that the axis behaved in such a way that the 
model was able to perfectly describe all aspects of axis behavior as indicated by the 
measurements. A coherence which is low, for example less than 0.8 or 0.7, suggests 
that the axis is ejq)eriencing behavior which is not predicted by the dynamics model 
used. As noted, the preferred model of FIG. 1 takes into account Coulomb friction, 
viscous friction, gravitational effects, and inertia. A low coherence may also be caused 
by large amounts of measurement noise or axis vibration, or disturbance effects such 
as torque ripple. 

If the coherence number is consistently low on a certain axis of certain 
machines and the level of noise and disturbances is low, then the model might not 
adequately describe the axis, and feedforward might only partially reduce the 
following errors. Enhancements to the feedforward algorithm might be necessary to 
account for un-modeled behavior. A coherence larger than 0.9 indicates a good match 
between the model and the actual behavior. This means that the ability of feedforward 
to remove following errors is expected to be good. Thus, the coherence can indicate 
confidence in the accuracy of the modeled parameters. 

In addition, it has been found to be useful to simultaneously plot modeled 
torque (Tm) vs. time as well as commanded torque (Tcmd) vs. time, in order to provide 
a visual representation of possible reasons for a low coherence value. FIG. 1 1 is an 
example of such a graphical representation, wherein the solid line indicates the 
commanded torque Tcmd. and the dashed line indicates the modeled or synthesized 
torque Tm. 



FIG. 3 is a flow chart illustrating the steps in implementing the above- 
described automatic feedforward gain determination algorithm, according to a 
preferred embodiment of the present invention. At step 200, the axis which will be 



6. Flow Chart of Preferred Auto-Tuning Procedure 
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auto-tuned is run through a test excitation program. As described in further detail 
below in section III, it is preferred that this test program moves the axis back and forth 
at increasing maximum velocities. However, as also described below, other test 
motions could be utilized, so long as sufficient excitation as described herein is 
5 provided. 

During the excitation program, step 202 is executed, and the data acquisition 
capabilities of the CNC record the motor speed V, and the corresponding total torque 
command Tcmd which is fed to the torque control loop of the controller. It is preferred 
that thousands or tens of thousands of data points are taken relating motor speed to 
10 torque command. 

Alternatively, other system operation data could be taken. For example, as an 
? alternative to recording the torque command, the motor current which corresponds to 

each velocity could be recorded. In this case, the term Tcmd of equation (9) should be 
f ij replaced by the term K« * I, where I is the measured motor current in amps, and K, is 

1 5 the value for the motor torque constant used by the CNC and is based upon the type of 
if =^ motor used. Accordingly, using the motor current multiplied by the motor torque 

C constant is equivalent to using the motor torque command itself. Gf a three-phase AC 

motor is used, the three phase motor current must be transformed to a single phase 
equivalent. Also, this value for torque wiU be slightly different from the torque 
command due to the dynamics of the current control loop as modeled by block 20 of 
FIG. 1). FIG. 12 is an exemplary graph illustrating current and velocity 
measurements for one exemplary excitation program, the measurements being useful 
for automatically tuning the feedforward parameters according to this altemativfe 
embodiment. It is also contemplated that, according to another alternative 
2 5 embodiment, equations could be set up based upon system operation data comprising 

the velocity command and the corresponding velocity output of the motor. 

Once the data is collected, it is preferred that the data is filtered, as shown at 
step 204. It is preferred that equations (14), (15), and (16) described above are 
utilized for zero-phase-filtering the data. 

After the data is filtered, it can then be used in the Newton's law equation 
described above, wherein the sum of the torques applied are set equal to the 
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acceleration times the moment of inertia. Equation (11) shows this equation in matrix 
form. To set up the matrix [A] of equation (1 1), equations (10), (12), and (13) can be 
utilized, as described above. In the flow diagram of FIG. 3, these steps are 
represented as block 206. 

Once the matrix [A] of the Newton's law equation is set up, the columns of the 
matrix should be scaled, as discussed above, in order to provide for a condition 
number which is easier to interpret. Equations 25-28 can be utilized for this scaling 
process, which is represented as step 208 of FIG. 3. 

Once the matrix [A] is scaled, the vector {P} of the Newton's law equation 
can then be solved, at step 210. Possible methods for solving the equation include the 
normal equations technique and the single value decomposition technique. The steps 
involved in solving the equation using the normal equations technique include finding 
the quantity [A]^[A], using Jacobi's method for finding the eigenvalues and 
eigenvectors of [A]^[A], using the eigenvalues and eigenvectors, along with equation 
(21), for finding the inverse of [Af [A], and using equation (1 8) to find the scaled 
parameter vector {P} . 

Once the eigenvalues and eigenvectors are known, step 212 can be executed 
and a condition number can be calculated to determine the level of excitation achieved 
by the excitation program. Equation (24) can be utilized for this purpose. 
After the condition number has been foimd, step 214 can be performed, and an 
excitation number can be determined, which allows the condition number to be more 
easily interpreted. Equations 31-32 can be utilized for determining the excitation 
number. 

Then, at block 215, a theoretical torque command sequence T^ is 
"synthesized," such as by using equation 33 above. As discussed above, it can be 
usefiil to compare this theoretical, or "modeled" torque to the actual torque 
commands, such as by plotting the two on the same graph. 

Next, at step 216, a model coherence number can be calculated to determine 
how well the values obtained for the solved vector {P} correspond to the actual 
measurements which were recorded during step 202. Equation (35) can be utilized 
to obtain the model coherence number 
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Then, at step 218, the vector {P} can be scaled to arrive at the actual values of 
viscous friction B, the constant offset (gravitational) torque Tconst. the Coulomb 
friction torque Tfe, and inertia J. Equation (30) can be used for this scaling. Once 
these parameters are fovmd, they can be used for the viscous friction feedforward 
parameter Gyisc for the constant offset feedforward parameter Gconst» and for the 
Coulomb friction feedforward Gcoul. and for the inertia parameter Ginertia 
respectively. This step is shown in FIG. 3 as step 220. Then, the acceleration 
feedforward gain Gaff can be set to 100%. 

Alternatively and as discussed above, the gain G^ff can be calculated such 
that, when multiplied by the total inertia (estimated manually), the product equals the 
solved inertia parameter J of the vector {P}. 

Accordingly, the steps described above allow for the automatic tuning of 
feedforward parameters, thereby saving time, increasing accuracy, and eliminating the 
need for a skilled technician to perform calcvdations. It is contemplated that a number 
of alternative and/or additional equations and measvirements could be utilized in 
automatically tuning these feedforward parameters. Also, it is contemplated that the 
method could be performed without the use of a condition number, excitation number, 
or coherence number. However, the excitation nxmiber and condition number are 
b^eficial because they provide an indication of how well the test program which was 
utilized excited the various modes of operation of the axis. Also, the coherence 
number provides an indication of the accuracy of tiie derived parameters of the vector 

{P>. 

In an alternative embodiment of the present invention, and as discussed in 
further detail below, PI compensator gains can also be estimated. In particular, a 
method and apparatus is disclosed for estimating the velocity loop parameters Kp and 
from measurements of the torque command Tc, the Velocity feedback Va, and the 
velocity command Vc. In this embodiment, the PI compensator parameters can be 
automatically estimated to allow for the implementation of a feedforward system on a 
hardware implementation utilizing an analog interface between the CNC and servo- 
drive. This embodiment is discussed in section V below. 




///. Optimum Excitation Part Programs and Automatic Generation Thereof 

According to one aspect of the present invention, the part program used to 
excite the axes can be automatically generated. The part program can be generated 
based on test setup data provided by the user, and a set of predetermined criteria 
expected to result in optimum excitation of all of the modes of the axis model. 

According to the preferred embodiment, the excitation (i.e, test) part program 
excites each axis by commanding a series of moves, each axis being moved and tuned 
individually. The lengths of the moves, the velocities of the moves, the 
acceleration/deceleration mode of the moves, and the location of the other axes during 
the move can be determined based upon the setup data. The type of motion and 
sequence of moves is preferably predetermined, and based on knowledge about the 
machine tool behavior which will provide the optimum test program. 
A. The Optimum Excitation Program for the Model 
More specifically, the importance of sufficiently exciting all "modes" of 
behavior included in the structure of the model was discussed above. If the axis is not 
sufficiently excited, there is a possibility of falsely attributing an observed behavior to 
an improper component of the model. Another problem occurs when there is 
excitation of a behavior which is not included within the scope of the model, which, in 
the illustrated embodiment, accounts only for Coulomb and viscous frictions, inertia, 
and gravity. In such circumstances, the behavior might be falsely attributed to one of 
the "modes" contained within the stmcture of the model, or can result in reduced 
coherence. Accordingly, if the conditions under which one of these un-modeled 
modes of behavior is excited is unlikely to be encountered in real applications or does 
not benefit from feedforward, then excitation of this mode should be avoided. 
Examples of known modes of behavior which should be avoided, and how to avoid 
them are given below. By eliminating axis commands in the test program which may 
excite these modes, the excitation program can be defined by a set of axis commands 
which are appropriate for the model. 

7. Situations to Avoid 
The first mode of behavior which is preferably avoided is static friction or 
stiction. Static friction only plays a role when the axis is at rest. Since stiction 
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feedforward is not incorporated by the preferred integrated feedforward model 
described above, it would be undesirable to have the part program excite stiction 
related phenomena. In many cases, stiction could result in a residual motor torque 
which gradually decays to zero after the axis comes to a complete stop. This behavior 
would likely be falsely attributed to Coulomb friction and should be avoided. 

One way to avoid this behavior is to not allow the axis to come to a complete 
stop. However, this would require that the axis move in only one direction and would 
result in insufficient excitation for distinguishing between the Coulomb friction and 
the constant offset. Accordingly, it has been foimd that a way of nearly eliminating 
stiction effects is to limit the amount of time during which the axis is at a complete 
stop. This is done by commanding successive position commands with minimum 
dwell time between motion blocks (A motion block is a machine command or series 
of machine commands which will move the axis in the desired manner. The test 
program is preferably made of a series of motion blocks, as discussed below). 

Another stiction related behavior to be avoided is the existence of a stiction 
pre-load prior to the beginning of axis motion. A pre-load can occur when the axis 
comes to a complete stop, but there remains, for some period of time, a motor current 
to counteract the combined effect of stiction and machine compliance. The effects of 
pre-load can be reduced by establishing a known pre-load prior to the sequence of 
excitation moves. This can be achieved by moving the axis in the direction of the first 
excitation move and dwelling for some period of time to allow the pre-load to decay. 
Thus, any pre-load which remains at the time of the first move will be in the direction 
of motion. This will have less of a corrupting influence on the estimates for 
feedforward parameters than would a pre-load that was opposite to the direction of 
motion. 

Another mode of behavior that is preferably avoided that is related to stiction 
is low velocity fiiction. At very low speeds. Coulomb friction often increases. This 
effect has been observed on machine tools, but it is not included within the scope of 
the preferred feedforward model above. Thus, in order to prevent this un-modeled 
behavior from adversely impacting the model parameter estimates, excessively slow 
feedrates should be avoided. The minimum feedrate is one of the test setup 
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parameters and the user should set up this parameter correctly to avoid excessively 
low feedrates. If the parameter is not programmed by the user, a default value of 10% 
of the maximum feedrate could be used. 

As with excessively slow feedrates. excessively high feedrates should also be 
avoided. One phenomenon which could occur at high feedrates is that the motor 
voltage may near saturation. Another such phenomenon is the reduction of maximum 
available motor torque due to non-linear changes in the motor torque constant. This 
could resuh in a different type of system behavior than is observed at the lower 
feedrates. Many machines are capable of moving their axes at feedrates which are 
well above the feedrates where cutting could realistically take place. Since 
feedforward is typically not applied during rapid moves, excitation of the axis in the 
test program with rapid rate moves should be avoided. 

Another phenomenon to be avoided is the excitation of structural and drive- 
train resonances. i.e. modes of vibration. Resonances normally occur at frequencies 
which are higher than the cutoff frequencies associated with a servo-controller. The 
preferred model described above does not account for structural vibrations, so 
excitation of these modes of the axis dynamics should be avoided so that they are not 
felsely attributed to one of the modeled phenomena. Since velocity and torque 
feedforward typically contain substantially more high frequency energy than position 
command signals, it is preferred that all feedforwards are disabled during execution of 
the test program. 

The acceleration and jerk rates of the axis also affect the level of excitation of 
structural resonances. TTie acceleration rate should be high enough to excite the 
inertial portion of the system dynamics but not so high that structural vibrations result. 
The test program can be configured such that such excessively high accelerations are 
avoided. 

Step changes in axis velocity also may excite structural vibrations. The 
excitation part program can avoid step changes in axis velocity by inserting a non- 
motion block between all motion blocks in order to force deceleration to zero velocity. 
Such a block should cause a deceleration to 2«ro, but not dwell at zero velocity due to 
tiie reasons stated above regarding stiction effects. 
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In addition, aliasing may cause frequency oscillations in the torque commands 
to appear as oscillations of lower frequency or as a DC offset. Aliasing occurs when 
the frequency of oscillation in the torque command signal is higher than half the 
frequency at which the signal is sampled by data acquisition. This effect can lead to 
large errors in the estimates for feedforward parameters and should be avoided. 

Accordingly, in order to avoid aliasing, high frequency oscillations in the 
motor current should be avoided. One particularly problematic cause of oscillations 
in the motor current is velocity feedforward. Velocity feedforward can cause 
oscillations in the current conunand when the axis undergoes acceleration. These 
oscillations are the result of the staircase velocity feedforward profile typically used 
by the digital servo. The response of the axis to the periodic discontinuities in the 
staircase profile can result in a motor current oscillation whose period is identical to 
the major update interval. Acceleration feedforward can have a similar effect during 
the changing acceleration portion (jerk roll regions) of the acceleration profile. 

It has been found that these oscillations arc greatly reduced if velocity and 
acceleration feedforward are turned off. Thus, when exciting the axis for the purposes 
of obtaining estimates for model parameters during the excitation program, it is 
preferred that velocity feedforward (as well as all other types of feedforward) are 
disabled. Furthermore, the digital servo should return a filtered velocity and torque 
command signal whereby a digital filter is applied to avoid aliasing of oscillations at a 
frequency of half the BPI and above. 

2. Preferred Design For Excitation Program 
As discussed, it has been found that the type of excitation which is required is 
that which will cause each of the modes of behavior accoimted for in the model to be 
excited to an approximately equal level. It has also been determined that a number of 
motion situations are preferably avoided. 

According to one aspect of the present invention, these considerations are 
combined with parameters provided by the user to automatically generate an 
excitation program. More specifically, according to one embodiment, when the 
automatic tuning feature is invoked, the user may choose to enter a number of 
parameters which define actuator movement limits via a user interface. These 



parameters can be stored permanently so that the user is not required to enter them 
each time. It is preferred that one of these user-definable parameters is a machining 
mode which indicates which predefined set of configuration parameters to be used 
during the excitation program. These configuration parameters include the step 
velocity limit, the acceleration limit, and the jerk limit If no machining mode is 
entered by the user, a default of "general machining" is selected to establish the most 
general operating mode for the particular machine. For some common machines, and 
as a point of reference and example, this configuration could include a step velocity 
limit of about 1000 mm/min, an acceleration limit of about 2000 mm/sec^ and a jerk 
limit of about 40,000 nun/sec^. However, it should be underetood that each "general 
machining" configuration is machine dependent and that these exemplary values 
would only apply to certain types of machining centers, and are only included as 
examples of typical values for particular machines. 

The user-enterable parameters also preferably include a start position 
indicating where the user would like the axis to begin just prior to the pre-load move, 
and a maximum end position indicating maximum axis position allowed during the 
excitation program. The maximum end position limits the program from moving the 
axis beyond the specified point, so as to avoid collisions with other components in the 
system, or other system "crashes." The user enters a maximum feedrate at which the 
test will run. A minimum feedrate at which the test should be run can also be 
selected. If no value is entered, a value of 10% of the maximum feedrate can be used. 
This minimum feedrate should not be excessively low, as indicated above. Also, the 
user can select locations for placement of the other axes which are not being tested. 

It is not necessary for the user to enter these values manually every time, as 
they can be saved as a configuration to be re-used by the auto-tuning excitation test. 

It has been foxmd that the preferred test motion routine is automatically 
derived by combining a series of forward and backward moves. FIG. 4 shows the 
velocity profile for two such axis moves. As can be understood by viewing FIG. 4, 
each pair of forward and backward moves preferably involves four motion blocks: 

• a motion block to command the axis to move to a target position at a 
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specified velocity 

• a motion block to ensure a Ml stop 

• a motion block to command the axis to reverse and return to the 
original position at the specified velocity 

5 • a motion block to ensure a full stop 

In the preferred embodiment, the excitation program is constructed by 
combining moves of this type for various velocities and move distances. The part 
program is preferably automatically generated based upon the following rules, which 
allow the program to avoid the undesirable operating conditions described above, as 

10 well as to conform to the parameters entered by the user. 

I" 

j»J • Do not move to locations outside of the range specified by the user in 

ji I 

I'] the setup data. 

d • Do not move to locations which are outside the machine's progranuned 

range limits. 

• Do not attempt to collect more data than can fit into the data 

acquisition buffer. 

• The initial commanded axis move is to be at the user-specified 
minimum test velocity. 

• The final commanded axis move is to be at the user-specified 
2 0 maximum test velocity. 

• The distance traveled for minimum velocity move is determined such 
that constant velocity time equals the sum of the acceleration and 
deceleration time. 

• The distance traveled for all other moves is determined such that 
constant velocity time is equivalent to constant velocity time of the 
minimum velocity move. 

• The number of pairs of back and forth moves (i.e. , "bi-directional" 
moves) can be set by the user as desired. Alternatively, this value can 
be preset for a particular number of pairs of moves, such as four pairs 
of moves, for example. The velocities for the moves are preferably 
equally spaced between the minimum velocity and the maximum 
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velocity. 

• The amount of time at relatively high velocities should be 
approximately equal to the amount of time at relatively low velocities. 

• The amount of time the axis undergoes acceleration should be 
approximately equal to the amount of time the axis does not undergo 
an acceleration (i.e. remains at a constant velocity). 

• The amount of time moving the axis with a positive velocity should be 
approximately equivalent to the amount of time moving the axis with a 
negative velocity. 

• Application of feedforward commands should be disabled during the 
execution of the excitation test program. 

It has been found that these rules can allow the derived program to avoid the 
undesirable or un-modeled situations which are described above, and to 
simultaneously conform to the parameters entered by the user. Such a program, it has 
been discovered, provides maximum excitation for the model. 

However, it is contemplated that other forward-backward excitation programs 
having velocity profiles other than that shown in FIG. 4 could be utilized without 
departing from the scope of the invention. For example, FIG. 5 illustrates a velocity 
profile for an alternative excitation program, wherein the axis is moved back and forth 
to decreasing maximum velocities at decreasmg acceleration rates. 

Once the excitation program is automatically generated, a "preview" mode can 
be utilized in order to test the excitation program before actually undertaking data 
acquisition. This mode of operation preferably only moves the axis through the 
maximum velocity moves specified in the generated program, so that the entire 
motion sequence need not be executed. Such a preview mode allows the user to 
determine whether the excitation program will cause a collision. Data acquisition can 
be disabled during the preview run. 

a. Computation of the Constant Velocity Time for All Moves 
As discussed above with respect to FIG. 4, it is preferred that the length of the 
minimum feedrate move is such that the total amount of time spent accelerating and 
decelerating is equal to the amotint of time spent at constant velocity. Referring to the 
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left most pulse in FIG. 4, the constant velocity time Tv should be equal to the total 
acc/dec time 4*Tj + 2*Tai, where Tj is the amount of time spent in the constant jerk 
regions and T^i is the amount of time spent in the constant acceleration regions. The 
following equations can be used to implement these constraints. 

The time spent in the constant jerk region is preferably based on the maximum 
axis acceleration and jerk allowable for the axis to be tested. 

T = ^^^-^^^ (36) 
max^jerk 



Accordingly, the change in velocity through the. constant jerk region is: 

= ^ ^max^jerk^Tj (37) 



The time spent in constant acceleration for the minimum programmed feedrate 
V, is Tai and can be calculated as follows: 



T = < 



ma x_acc 
0 



(38) 



Then, the constant velocity time can be set such that it is equal to the 
acceleration time plus deceleration time. 

r = 2 + 4 * r, (39) 

If the minimvim programmed velocity V, is less than 2*Vj, the velocity V, will 
generally be too low to allow constant acceleration to be attained. If this is the case. 
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Tai can be assumed to be zero, and the constant velocity time can then be set to four 
times the constant jerk time. The result will be that for the minimum feedrate move, 
the constant velocity time is longer than the constant jerk time. In addition, in the 
preferred embodiment, if the computed constant velocity time is less than a hard- 
coded lower limit (e.g., 0.25 seconds), then it is set to be equal to this lower limit. 

b. Generation of Motion Blocks for Axis Excitation 
Once the acceleration and constant velocity times are calculated, the algorithm 
can proceed to automatically generate the motion blocks for the excitation program. 
Each back and forth motion has a different constant velocity region, which is between 
the minimum user-programmed velocity and the maximum user-progranuned 
velocity. These various velocities and the total length of the move for each of the 
various velocities can be generated in a loop. In the loop, the loop index n preferably 
begins as zero and is incremented until it reaches the specified number of moves, 
which can be entered by the user, or, even more preferably, hardcoded to a particular 
nvimber, such as four, for example. 

More specifically, the velocities can be distributed linearly between the 
minimum programmed feedrate and the maximum programmed feedrate based upon 
the number of moves: 

V = V +n* ^«Ax-^«iN (40) 

n HiN num moves - 1 



The acceleration time TA„for each velocity can then be calculated as 
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-JL-2*V, V 
60 ^ n 

J ' "60 ' " (41) 
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Once the acceleration time is known, the length of the move (i.e. how far the 
axis will move for the particular velocity) can be calculated based upon the constant 
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velocity time Tv, the velocity V„, and the acceleration time T^n : 



(42) 



Once the length of the move is known, the destination position for the 
particular back-and-forth move can be determined. The destination position for move 
n can be given the symbol X„ and the initial position prior to the excitation moves 
(and after the pre-load move) can be given the symbol Xj. 

The direction of the first move depends on whether the user-specified 
maximum end position is greater or less than the user-specified, start position. A 
variable s can be computed for this purpose: 

s = sgn (max_end_position-start_position) (43) 

The destination position can then be computed by adding the product of s and 
move length L„ to the initial position Xj. If the destination position is beyond either 
the maximiun end position specified in the setup data or the high or low limit for the 
particular machine, then the destination position is assigned to the most limiting of 
these two constraints. 

X, » mrtjiotitioa ♦ *«PRBLOAD_MOVB 

jr, ♦ . ((Jr,*#I^<highJimit) ft ((Jir,^*L^>lowJimit) ft (*(m»x_endj>o» -(X, ♦#L,))<o) ' 

^ high_Umit , (htghjimit < (JIT, ♦* I ft (bigh.Umit < m«x_end_pogition) 

^ ' lowjimit . (lowjimit > (JT, ft (lowjimh > max.eadjiosition) 

inax.ead joi , otherwise 



As shown in FIG. 4, the motion blocks themselves command a move to the 
destination position, a no-motion span or "dwell" to ensure that the velocity profile 
ends in a full stop, a move back to the initial position, and another no-motion span or 
"dwell.'* The dwell size is preferably less than a BPI to minimize the amount of time 



the axis spends stopped. An example motion block for the case where the X axis is 
exercised is shown below in machine tool code. In the block, the variable X; indicates 
the starting position for the axis, the variable X„can be obtained through equation 
(44), and the variable V„ can be obtained through equation (40). The variable bpi is 
the predefined basic process interval for the control (e.g., 3 milliseconds, 5 
milliseconds). 



G90 Gl X<X„> F<V.> 

G4F<bpi/2> 

G90 Gl X-<Xi> F<V.> 

G4F<bpi/2> 

Preferably, four back-and-forth moves are made using four such motion 
blocks, with the first move being at the specified minimum velocity and the fourth 
move being at the specified maximum velocity. The subscript w is an index indicating 
which move in tiie sequence is referenced. 

c. Flow Diagram 

FIG. 6 is a flow diagram illustrating the preferred method for automatically 
generating the excitation program, as discussed above. At step 248, the process is 
commenced, and the loop index n is set equal to zero. Then, at step 250, the user- 
definable parameters are obtained, preferably via a graphical user interface 
implemented on a workstation which is a part of the CNC, or firom an existing - 
database where the values are stored permanently. As discussed above, these 
parameters can include the starting position for the axis to be tuned, the maximum end 
position for the axis, the maximum and minimum feedrates, other axes' positions, and 
process mode, to be used for the tuning. 

Once the parameters are entered by the user, the constant velocity time T^ (the 
amount of time during which the axis will travel at a constant velocity, for each 
velocity being tested) is calculated. This is represented as step 252 and can be 
implemented via equations (36) through (39) above. As noted, it is preferred that this 



50 



# 



constant velocity time Tv is set equal to the total acceleration and deceleration time for 
the given backward or forward movement. 

Once the constant velocity time is computed, step 254 is executed and the 
other axes, which are not being tuned, are moved to their collision-avoidance 
positions, which can be specified by the user at the set-up step. This is done to move 
the other axes out of the way to avoid collisions. 

Steps 256 through 266 make up a loop, based upon the loop index n, which 
determines each of the various feedrates (i.e. velocities) which will be reached 
during the excitation program, as well as each of the various destination points X„ to 
which the axis will move during each back-and-forth movement of the program, VI 
and V2 of FIG. 4 are examples of two of the velocities V„ which are reached during 
the program. 

In particular, each velocity V„ is calculated at step 256. This calculation can 
be made through use of equation (40) above. Once the velocity is determined for the 
particular iteration of the loop, the length of the move is calculated, at step 258. 
This calculation can be made through use of equations (41) and (42) above. Based 
upon the calculated move length L„ and the velocity step V„ for the loop iteration, the 
destination position can then be determined, at step 260. This calculation can be made 
through use of equation (44) above. 

Then, at step 262, a motion block (e.g., a series of conunands) can be 
generated for the X„ and V„ which were calculated. An exemplary motion block is 
discussed above. 

At decision step 264, it is determined whether the loop index has reached three 
(such that the preferred number of four back and forth movements are utilized). If 
not, the loop proceeds to step 266, wherein the index n is incremented by one. Then, 
the loop continues back to step 256, wherein the next back-and-forth motion block can 
be generated for the next incremental velocity Vn. 

If the loop index n does equal three, then the process proceeds to step 268, and 
the excitation program is ready for operation. At this step, the part program is 
executed by the CNC control and the axis moves back and forth four times according 
to the fovir motion blocks, and reaches an ever increasing velocity each time. 



During this excitation program, step 270 is executed and system operation data (e.g., 
velocity measurements and corresponding torque commands) is acquired by the CNC 
during the program. After the test program is complete, step 272 is executed, and the 
feedforward parameters are estimated and displayed. Preferably, the method of FIG. 3 
is utilized to calculate these parameters. The proposed feedforward parameters can 
then be viewed by the user and accepted or rejected. The condition number, 
excitation nvimber, and/or coherence value, which are discussed in detail above, can 
be utilized for this purpose. 



IV. Tuning Additional Feedforwco'd Parameters. 

Application of feedforward to more complex machines may require that the 
complexity (order) of the model describing the axis dynamics be increased. 
Accordingly, it is contemplated that at least the following model enhancements could 
be utilized. 

Several phenomena which are not included in the present implementation of 
the feedforward model may result in torques applied to the motor. Some of these 
phenomena include: 

• Position dependent Coulomb friction 

• Static friction 

• Compliance of machine components 

In order to implement the least squares solution as described in the previous 
model, these phenomena would have to be expressed as a linear scaling of some basis 
function which is completely determined by the data acquisition measurements. 

A. Position Dependent Coulomb Friction 

Changes in the Coulomb friction level associated witii a controlled axis may 
occur witii tiie position of tiie axis. This effect could be caused by any number of 
factors. One possible cause is misalignment between the ballscrew and ways resulting 
in binding. One way of describing position dependent Coulomb friction is to express 
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the Coulomb friction level as a polynomial in axis position. A second order 
polynomial would allow for several types of position dependence: 1) an increase in 
friction as the axis position varies from one end of its range to the other, 2) a decrease 
in friction near the center of the range and increase in friction near the ends of the 
range, 3) an increase in friction near the center of the range and a decrease near the 
ends. If the Coulomb friction level for the X-axis is expressed as a second order 
function of X: 

then the Coulomb friction applied to the axis would be expressed by: 

T^^^SigniV) - a^X* Sign {V) *a^XSign{\n * assign {V) 



(46) 



This position depMidence can be included in the preferred model described 
above by inserting the matrix form of equation (46) into equation (lO)as follows. 
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B. Static Friction 

A simple model for static friction or "stiction" is the torque which must be 
exerted on the axis in order for the axis to break-away from a resting position. If 
stiction is present, then it may exhibit a behavior whereby the motor exerts a residual 
torque on the axis in order to maintain the at rest position of the axis. This torque is 
the result of stiction combined with compliance. In particular, as the axis slows down 
to a stop, at some critically slow velocity it will "stick" and come to a complete stop. 
At this point, the axis may not have reached its final position and some small 
following error may remain. Any such following error results in a velocity 
command, which results in a torque command which is steadily increased in time by 
the integrator. 

At first, before the integrator has built up, the following error will result in a 



proportional motor torque. This torque will be opposed by the static friction torque in 
combination with the stiffness of the axis components between the motor and the 
location where the stiction force is applied. Torque is also affected by the inertia of 
this portion of the structure. If the stif&iess is low, i.e. compliance is high, then the 
residual motor torque will be low, and the majority of the following error will be 
taken up by compliance. If the stifi&iess is high, then the residual torque will be closer 
to the stiction level and the following error will remain at its initial level. With the 
passage of time, the integrator will begin to build up, resulting in increased motor 
torque, resulting in reduction of following error through compliance of the structure 
between the "stuck" component and the. axis motor. Thus, the residual following 
error will be reduced to zero in the presence of an integrator. 

Assuming that the integrator torque builds up enough to remove the residual 
following error without causing the stuck element to break away, at steady state there 
will be a torque command opposed by the stif&ess of the structure between the motor 
and point of stiction. This level of torque can be obtained by including a colimm in 
the matrix of equation (10) which contains a zero when the axis is in motion, a 1 when 
the axis is at rest and most recently experienced a positive velocity, and a -1 when the 
axis is at rest and most recently experienced a negative velocity. 

C Structural Compliance 

Methods for obtaining the natural frequencies of structural vibrations due to 
compliance are available and can be incorporated into the model. In particular, the 
axis can be modeled as consisting of multiple inertias and the discrete difference 
approach for acceleration can be dropped and replaced by use of shift operators (Z- 
transform methods). 

D. Diagnosing Machine Health 

It is also contemplated that the present invention can be utilized to diagnose 
the health of a particular machine. For example, the automatic parameter estimation 
program can be executed periodically and the values derived compared to the values 
previously derived for the machine (e.g., the parameter "history")- If the difference 
between a newly estimated parameter and the previous values estimated for the 
parameter is statistically significant, or exceeds a predetermined safe threshold, then a 
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machine problem could be present. 

V. Hardware Implementation 

FIG. 7 is a block diagram illustrating a potential hardware configuration for 
implementing the above-described feedforward control system having automatic 
tuning capabilities. The illustrated system is microprocessor based and includes a 
computer 400 having a CNC control unit 4 1 0 and a servo controller unit 412. The 
CNC control unit 410 includes a position command generator 414 which provides 
position commands based upon the part program to the servo-controller 412 and to a 
feedforward command generator 416. Based upon the position conunands and 
feedforward gains, the feedforward command generator then provides feedforward 
commands to the servo-controller 412. 

The CNC 410 also includes an automatic tuning unit 418 for tuning the 
feedforward parameters which are utilized by the feedforward command generator 
416 to derive feedforward commands. Preferably, the auto-tuning unit 418 operates 
as discussed above, and preferably includes capability for automatic generation of the 
excitation program based upon data provided by the user through an input device on 
the computer 400. 

From the position commands, feedforward commands, and feedback 
measurements, the servo-controller 412 then generates the voltage command signals 
to be fed to a PWM (pulse width modulation) amplifier 402. The servo-controller 412 
preferably includes position, velocity, and current feedback loops and commutation 
functions for producing the voltage commands, such as those described above with 
respect to FIG. 1. The servo-controller 412 and PWM amplifier 402, along with a 
current measuring device for measuring the current from the amplifier, form a current 
control loop, as shown in FIG. 7. 

The voltage commands fi-om the servo-controller 412 control the PWM 
amplifier 402. The three-phase voltages are sv^tched via the PWM amplifier 402 to 
the AC electric motor 404. The value of the developed three phase currents are 
detected and fed back to the servo-controller 412 in the current control loop 
configuration. In response to the three phase currents, the motor 404 is rotated and a 
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movable member comiected to the motor 404 is moved. An encoder 106 is used for 
determining the position and velocity of the motor, which are fed back to the servo- 
controller 412. The auto-tuning unit 418 preferably utilizes a velocity estimate based 
upon velocity measurements from the encoder 106, as well as the torque commands 
from the servo-controller 412 to automatically derive the feedforward gains, as 
discussed previously. 

As can be understood, the automatic-tuning unit 418, the feedforward 
command generator 416, and the position conmiand generator 414 be embodied as a 
program or programs on a computer readable medium,, such as a . ROM unit, or 
other persistent storage medium. These units can also be embodied as special 
purpose apparatus having executable instructions stored in a RAM or ROM, or a 
combination of both. Moreover, the instructions and/or programs can be 
implemented in any conventional programming language, such as, for example, C, 
or C + +, or can be implemented in a special purpose programming language. 
Preferably, the C programming language is utilized. Similarly, many of the 
functions of the servo-controller 412 can be carried out according to progranmied 
instructions. 

A, Analog Interface Between the CMC and Servo-Controller 

As shown in FIGS. 8 and 10, the present invention may be implemented on 
control systems with an analog interface between the CNC and servo, or systems with a 
digital interface between the CNC and servo. 

Figure 8 shows an embodiment where, feedforward auto tuning is implemented 
on a system with an analog interface between the CNC and servo. In this embodiment, 
CNC controller 100 incorporates two independent processes: a real time process 104 and 
a non-real-time workstation process 102. Each process can operate on a separate 
computer subsystem, if desired. However, embodiments where both processes are 
executed on the same computer (CPU) are also included within the scope of the 
implementation shown in FIG. 8. 

Within the workstation process 102 is stored configuration data 122 that specifies, 
among others, the parameters for axis motion, such as acceleration and jerk, for example. 



The feedforward generation function 116 uses this configuration data along with auto 
tuning test setup data 1 14 in order to generate the excitation part program which is loaded 
into the part program storage area 118. 

In the embodiment of FIG. 8, program execution takes place on the real time 
system where the part program interpreter 124 generates geometric data that is provided 
as an input to the position command generator 126 (also known as an interpolator) which 
outputs a new position conmiand for each axis every BPI. 

FIG. 8 shows an example of a system of two axes actuated by motors 1 52 and 1 60 
which are powered by servo-drives (i.e.,. controllers) 106 and 158, respectively. It should 
be imderstood that, while two axes are shown in the example, any number of axes may 
be present without changing the nature of the system. 

The position command generator 126 outputs multiple position commands every 
BPI - one for each axis under active control. Considering just one axis, and with the 
understanding that the forthcoming description can pertain equally to any axis under 
control, the position command generated each BPI is operated on by the axis position 
control function 130 and the axis feedforward command generator 128. The axis position 
control function receives the axis feedback position from the position detection function 
136. The axis position control function 130 and the feedforward command generator 
function 128 both output a velocity command. The two velocity commands are added 
together by a summing function 132, and the total velocity command for each BPI is 
converted to a voltage ouQ>ut by the digital to analog converter 134. The analog output 
voltage is then applied as input to the standalone axis servo drive 106 attached to the axis 
imder control. 

The servo drive 106 comprises an analog to digital converter or ADC 144, which 
converts the analog signal into a digital representation of the velocity command. The 
servo drive's ADC 144 performs analog to digital conversion periodically at a uniform 
time interval that is typically shorter than the CNC's BPI. The servo drive's time interval 
for analog to digital conversion is typically equal to the time interval for velocity control 
and is referred to herein as the minor update interval. The required velocity is applied to 
the velocity-control/torque-control/commutation function 146. The velocity-control 



function of block 146 requires velocity feedback and typically receives velocity feedback 
from the position and velocity detection function 148. To provide this velocity feedback, 
the position and velocity detection function 148 receives a signal from a feedback device 
such as an encoder 154 attached to the motor shaft, and the encoder signal is interpreted 
by block 148 in order to provide a measurement of motor angle and motor velocity. 

Using the velocity control output, block 146 produces a required torque or torque 
command which is provided as input to a torque control loop, also within block 146. To 
perform this torque control function, block 146 requires current measurements, which can 
be provided by a sensor within the PWM.(pulse width modulation) amplifier 150. 

In addition to torque and velocity control, function block 146 also performs a 
commutation function in the embodiment of FIG. 8. To perform this function, motor 
angle data is required, and is provided by the position and velocity detection function 
148. The primary output of the velocity-control/torque-control/commutation function 
block 146 is a three phase voltage command which represents the required voltage on 
each of three windings of the synchronous AC servo-motor 152. As can be understood, 
a DC servomotor may be substituted for the AC servo motor 152, and only a single phase 
voltage command would then be required. 

As is known in the art, the voltage command (either single or three phase) from 
block 146 is provided to the PWM amplifier 150, which uses switching techniques to 
produce the required voltage or voltages on the armature winding or windings of motor 
152. 

Although the interface to the servo drive 106 is analog, the servo drive is itself a 
digital device that controls velocity at equal time intervals referred to as the "minor 
update interval," This update time is typically a smaller period of time than the BPI, 
often 4 to 20 times as small. This document uses t„ to denote the minor update interval 
of the velocity servo 106. 

As the feedforward auto tuning excitation program is executed and axis motion 
is generated, the required data for making the parameter estimations can be stored in 
memory 138 on the standalone servo drive 106. As discussed herein with respect to the 
automatic tuning invention, this data can include the velocity command, velocity 
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feedback, and torque command. In one embodiment, data from every minor update 
interval during execution of the test program can be stored in the drive's on-board data 
storage 138. Another possibility would be to store re-sampled data in the on-board data 
storage 138. "Resampling" data is the process of collecting data every n minor update 
intervals, where n is a constant integer. If this approach is used, in order to avoid the 
effects of aliasing, the original data, gathered once per minor update interval, should fu-st 
undergo a process of digital anti-alias filtering where the majority of the signal's energy 
content that resides in a firequency range that is above half the resampling frequency is 
removed firom the signal. The process of anti-alias filtering and resampling is illustrated 
in FIG. 8 by block 142. 

Once execution of the test program has completed, the feedforward graphical user 
mterface (GUI) 1 12 of the workstation 102 causes the CNC's communications interface 
108 to retrieve the data firom the communications interface 140 of the servo drive 106. 
The communications interface 108 might incorporate a serial conununications protocol 
as one possible embodiment. Also, multiple servo-drives can be networked together 
using a suitable network topology such as a ring, a web, or a multi-drop. 

Once the data is retrieved firom the servo-drive 106, the GNC 100 can store the 
data in its own measurement data storage area 1 10. Once all the requu-ed data fi-om all 
the required drives has been retrieved, the feedforward auto tuning parameter estimation 
function 120 operates on the measurement data in storage area 1 10 and computes the 
feedforward parameters for each axis, such as by using the Newton's law equations and 
matrix solutions methods described above. These feedforward parameters can then be 
displayed on the feedforward GUI 1 12 to allow the user to decide whether or not to 
accept them. If the user accepts the parameters, they can be written to the configuration 
data storage area 122. The real time feedforward command generator 128 can then use 
the data stored in 122 as the feedforward gains, as described above. 

As shown in FIG. 8, the analog interface system requires two additional 
parameters to be tuned by the automatic tuning invention, in addition to the parameters 
previously discussed (Gvff.Gaff. Gcoul Gyisc. Gconst). In particular, implementation of 
integrated feedforward on a so-called "analog servo interface" system may be 



accomplished if precise estimates of the velocity loop compensator's parameters are 
known. As described above, the velocity command voltage in FIG. 8 is applied to a 
stand-alone servo drive 106 that attempts to cause a motor 152 to move with the 
commanded velocity by use of a closed velocity loop. The closed velocity loop most 
often contains a PI compensator whose input is an error between a command velocity and 
a measured velocity (feedback velocity) and whose output is a torque command. Thus, 
because the input to the servo 106 is a velocity conunand only, and not a velocity and 
separate torque command, a requirement of accomplishing integrated feedforward on a 
system with an analog servo interface having only a velocity input is that the torque 
feedforwards are transformed into velocity feedforward. This can be accomplished by 
a filter that closely approximates the inverse dynamics of the PI compensator used by the 
velocity control loop of block 146. Thus, a high precision estimate of the PI 
compensator's parameters is required to perform the filtering. The way in which these 
parameters are used by the compensator is described below. 

These compensator parameters are Kp - the proportional gain and BC, - the integral 
gain- Because these parameters enable feedforward to operate on the exemplary system 
of FIG. 8, they are considered feedforward parameters. Tn certain systems, the servo 
drive's internal representation of the velocity loop parameters are scaled specifically to 
the servo drive. Often, the CNC controller 100 doesn't have enough information about 
the servo drive's 106 configxiration and intemal software to be able to represent the 
parameters in the required way. This problem is solved by another aspect of the 
automatic tuning program of the present invention, in which the values of the yplocity 
loop parameters are estimated via analysis of measured data. 

As discussed above, standalone digital servo drives can have the ability to store 
historical data regarding the command and feedback signals firom previous minor update 
intervals (see data storage block 138 of FIG. 8). This data may be delivered to the 
feedforward auto tuning capability 120 that is resident on the control 100 by some 
communication interface (108 and 140), such as an RS232 interface. The data can be 
transferred as a non-real time process after the test motion has been completed. On the 
CNC 100, the data can then be used to estimate the inertia. Coulomb friction, viscous 



friction, and constant offset. The methods for estimating these parameters by analyzing 
torque command and velocity feedback data have already been described, such as with 
reference to FIG. 3, for example. 

In order for the auto-tuning algorithm 120 of FIG. 8 to also estimate the velocity 
5 loop compensator parameters (Kp and K,), it has been found that the velocity command 

signal can be measured and utilized, in addition to the torque command and velocity 
measurements. In one preferred approach, measurements of the velocity command 
signal are made over an interval that is equivalent to the CNC's BPL In order to avoid 
data corruption by aliasing, the data is preferably digitally filtered on the drive 106. 
IjlO Digital filtering and re-sampling may be performed by the drive 106 in real time in order 

to reduce the memory requirement for storing the data on the drive. 

In particular, the following discussion describes a technique for estunating the 
^ velocity loop parameters Kp and Kj from measurements of the torque command Tc, the 

velocity feedback Va, and the velocity command Vc, according to another aspect of the 
pl-S automatic tuning method and apparatus of the present invention. The sampling interval 

for these measurements is t, and is preferred to be equal to the BPI T, but this is not a 
requirement for the algorithm to work properly. For cases where the sampling time is 
greater than the minor update interval of the velocity loop, i.e. t,>t„, the digital filter 
representation of the velocity loop compensator is expressed in tenns of the discrete time 
domain variable for a sampling interval t,: z=exp(sg. The digital filter is preferably 
derived based on the bilinear transform. The derivation of the digital filter equation 
begins by defining the form of the continuous time representation velocity loop 
compensator. This is shown in FIG. 9. 

With reference to FIG. 9, according to one embodiment of the present invention, 
the parameters of the PI compensator are automatically estimated by investigating the 
relationship between the velocity error Ev and the torque command Tc. The velocity 
error for time sample number k is computed by subtracting the velocity feedback 
measurement from the velocity command measurement for the time sample k. 

£„(*)=Kc(A)-K^(ifc) 
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The PI compensator must be represented as a discrete time equivalent in order to 
determine its parameters from discrete time data. The bilinear transform is used to create 
the discrete time equivalent. The bilinear transform is defined below. 
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Application of this transform to the PI compensator yields the following discrete time 
representation of the velocity loop compensator, which is denoted by D(z). 



The difierence equation associated with the previous digital filter is the following, 
which relates torque conmiands to velocity error. Because the torque commands and 
velocity error can be measured, the two unknowns, Kp and K^, can be found. 



Formulating the previous equation at each tune point and represehtmg the 
equation in matrix form, provides the following matrix equation of an overdetermined 
system with N»2 measiurements. 



f 7-^(2) -red) 1 
TcO)-Tc(2) 
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This overdetermined system can be solved for rl and r2 using techniques such as 
the normal equations or singular value decomposition methods described above. The 
coherence and condition mmiber may also be determined using techniques completely 
analogous to those discussed earlier. In computation of the condition number, scaling of 
the EV matrix is not necessary because both columns have identical units. The condition 
number that indicates sufficient excitation for computing Kp and K, is not necessarily the 
same value as the condition number that indicates sufficient excitation for computing the 
torque feedforward parameters. 

Once values for rl and r2 are obtained, the estimates for the PI compensator 
parameters are obtained from the following equations. 



2~ ' '"kT^ 

Thus, according to another aspect of the present invention, the compensator 
parameters can be automatically estimated to allow for the implementation of a 
feedforward system on a hardware implementation utilizing an analog interface between 
the CNC and servo-drive. These compensator parameters can be found by recording 
torque conmiands, velocity conmiands, and actual velocity, and using the above 
equations relating torque commands to velocity error. According to another aspect and 
as discussed above, the other feedforward parameters can also be tuned, such as by using 
the process of FIG. 3, and equations relating the sum of the torques to acceleration 
(angular or linear, depending upon motor type). 

B. Digital Interface Between the CNC and the Servo 

The implementation of feedforward auto tuning on a hardware platform that 
involves a digital servo interface is shown in Figure 10. As can be understood from 
comparison of FIGS. 8 and 10, the implementation is very similar to the case for the 
analog servo interface. 
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In the implementation shown in Figure 10, the CNC 100 incorporates a 
Workstation process 102, real time process 104, and servo process 164. Each of these 
processes may be executed on individual CPUs, a single CPU, or a combination of CPUs. 
As in the analog-interfaced system, the servo process 164 typically executes more often 
(at a smaller time interval) than the real time process. As noted above, the servo process 
time interval is referred to as the minor update interval. The servo process 164 controls 
the position, velocity, and torque of each axis by obtaining measurements of motor 
currents and motor shaft position. The primary output of the servo process 1 64 is a three 
phase voltage conunand which is fed to a RWM amplifier 1 52, which, in the embodiment 
illustrated in Figure 10, is a separate hardware device. Theonce-per-minor-update- 
interval variables of torque command and velocity feedback are subjected to a process 
of anti-alias filtering and resampling 142. The re-sampled data is delivered to the real 
time processor's measurement data storage area 168 through a mechanism such as a 
shared memory interface. This data can then be transferred to measurement data storage 
area 1 10, in the workstation 102, and utilized by the inventive feedforward auto-tuning 
parameter estimation program 120, to estimate/calculate/tune the feedforward gains Gvff, 
Gaff. Gcoul. Gconst. Gvisc» such as according to the process of FIG. 3. 

Thus, the key diflferences between the analog interfaced system of FIG. 8 and the 
digital interfaced system of FIG. 10, other than the interface used, are as follows. In the 
digital system, the velocity and torque commands are applied simultaneously firom the 
realtime process 104 of the CNC 100 to the servo 164, while in the analog system, only 
a velocity command is applied to the servo 106. As such, the torque feedforward 
commands from the CNC 100 in the analog system of FIG. 8 must be converted to 
velocity feedforwards, as described above, through the use of the compensator parameters 
Kp and Kj. These parameters can be estimated according to the automatic tuning program 
of the present invention, as also disclosed above. 

Another difference between the two systems is that measurement data from 
between the CNC 100 and the servo drive 106 of the analog-interfaced system of FIG. 
8 needs to be transferred via communications interfaces 108 and 140, while, in the digital 
system of FIG. 10, no such interface is required, as the CNC and servo are already 
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digitally connected. 

Although one embodiment of the present invention has been presented 
wherein a value for a compensation parameter(s) is determined by modeling behavior 
(e.g., the behavior of drive dynamics), it should be appreciated that a value of such a 
parameter can be determined by other methods. For example, an optimxmi value of a 
compensation parameter can be determined via iteration techniques. Such an 
embodiment might be useful where, for example, behavior is difficult to model. 

For example, in one embodiment of the present invention, a field bus (e.g., 
complying with the PROFIBUS standard) might be used to interface a position 
command generator and a feedforward command generator (e.g., as embodied in a 
CNC) with a controller, such as a servo drive (e.g., instead of an analog or digital 
interface). In a typical analog interface, such as that illustrated in Fig. 8, a CNC might 
send a servo drive an analog velocity command and could receive an encoder 
waveform. By comparison, in a typical field bus interface, a CNC might send a servo 
drive a digital velocity command and could receive a digital feedback signal which is 
a processed form of an encoder waveform. As can be understood, a time delay is 
introduced because of the processing needed to produce the digital feedback signal. 
Additional delays can also be introduced because of the communication time between 
the CNC issuing a command and the drive responding to the command. 

In an embodiment wherein a feedforward command is applied, for example, it 
can be beneficial to compensate for such a time delay. Accordingly, in one such 
embodiment, a time-shifl: parameter is utilized to tune a time-shifted relationship 
between a velocity feedforward command and a position command. As the time-shift 
relationship can be difficult to model, however, one embodiment of the present 
invention utilizes the aforementioned iterative technique to determine an optimiun 
value for the time-shift parameter. 

According to one such exemplary embodiment, optimxmi values are first 
determined for feedforward parameters, other than the time-shift parameter, that will 
be used in generating a feedforward command. For example, the techniques 
otherwise presented for proposing values for parameters such as an acceleration 
feedforward gain. Coulomb fiiction feedforward gain, viscous friction feedforward 
gain, constant offset feedforward gain, proportional gain, inertia and/or integral gain 
could be used to determine values for such parameters. According to an exemplary 
embodiment, the optimvim values proposed for such feedforward parameters are used 
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in the generation of feedforward commands used in the exemplary tuning operation. 
In one embodiment of the present invention, such optimum values are used during the 
tuning operation even if a user decides not to use one or more of the proposed 
optimum values during the normal operation of the control system (e.g., a proposed 
value is displayed to a user during a portion of the tuning operation directed towards 
that parameter and the user rejects the proposed value, such as via feedforward GUI 
1 12). In such an embodiment, the permanent values can be restored after the tuning 
operation is complete. 

In one embodiment of the present invention, the optimum values can be 
written to, for example, a configuration data storage area, such as configuration data 
storage area 122 shown in Fig 8. A starting value for the time-shift parameter can 
also be written to the configuration data storage area. 

An actuator whose motion is controlled based on the position commands and 
feedforward commands is moved in response to a test motion routine (e.g., an 
excitation part program), wherein the feedforward command is generated based on the 
aforementioned parameters. According to one embodiment of the present invention, 
the excitation part program is generated in conjunction with user-defined parameters 
such as, for example, starting point, stopping point, and duration of the test motion. 
As can be appreciated, such parameters could, for example, be received as input fi-om 
a user via a GUI, such as feedforward GUI 112. 

For example, the excitation part program can comprise one that results in the 
creation of position commands according to a sinusoidal waveform having a varied 
frequency (e.g., gradually increasing), which will be referred to hereinafter as a chirp 
input. According to one embodiment, the chirp input also has varying amplitude (e.g., 
gradually increasing and then gradually decreasing). One advantage of an excitation 
part program according to such an illustrative embodiment can be that it represents a 
wide range of commands that fully excites the system. 

The actual motion (e.g., as reflected in operation data recorded during the 
motion) and the commanded motion can be compared to determine any error (e.g., a 
following error). In one embodiment, the RMS error can be determined for the 
particular combination of parameters used to generate any feedforward commands 
applied during the test motion. Although an exemplary embodiment is presented 
herein wherein RMS error is used to quantify error, other methods of quantifying 
error can also be used. 
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A new value for the time-shift parameter is then written to the configuration 
data storage area and the test motion is re-run. The RMS error can be determined for 
the new combination and compared with that of the origined combination. Based on 
the comparison, yet another value of the parameter can be identified. In an exemplary 
embodiment, a user can be presented with a graphical representation of the test 
motion and/or the error (e.g., actual and/or RMS) for each combination. 

According to an exemplary embodiment of the present invention, 
minimization algorithm techniques can be used to analyze actual motion in response 
to the test motion routine for each combination of parameters and to iteratively 
identify new parameter values. For example, it has been discovered that resultant 
actuator motion generally takes the form of a function which can be analyzed using 
techniques of algorithms such as the golden section search algorithm, as described in 
Numerical Recipes. Using such techniques, values for a parameter such as the time- 
shift parameter can be iteratively identified and applied in test motions to ultimately 
determine an optimum value for the parameter. According to one exemplary 
embodiment, a user can be presented with an opportunity to accept the determined 
optimum value for the parameter (e.g., via feedforward GUI 1 12). 

One embodiment of the present invention might be implemented in software 
using the exemplary architecture depicted in Fig. 13. According to such an 
embodiment, the software (referred to hereinafter as timing software by example) is 
based on a layered approach wherein an interface (abstraction layer 510) is utilized to 
insulate, for example, a core 520 of the timing software (e.g., the core could represent 
that portion of the software where data analysis and optimum values for pareimeters 
are determined) from the particular requirements of, for example, a CNC 550, that 
might want to utilize the tuning software. One advantage of such an embodiment 
could include minimizing development costs by restricting development to that of 
appropriate abstraction layers for each type of CNC, for example. 

For example, tuning core 520 might require fimctionality for tasks such as 
opening a program on the CNC, loading a program on the CNC, identifying when a 
point in a program running on the CNC has paissed a certain point, identifying 
information about the CNC, etc. Meanwhile, abstraction layer 510 can provide 
control-specific implementation of these tasks that might be used by core 520. In the 
illustrated embodiment, tuning core 520 runs within an operating system 540 (e.g., a 
Microsoft Windows operation system) on a computing device. As can be appreciated, 
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in additional embodiments, tuning core 520 could also be isolated from such an 
operating system. 

In an exemplary embodiment, tuning core 520 utilizes an interface with a user 
(e.g., a human operator). In one embodiment, for example, a user interface 530 is 
5 developed as a separate layer having direct access to CNC 550. One advantage of 
such an embodiment might include allowing user interface 530 to emulate interfaces 
typically associated with the CNC being utilized. As can be appreciated, user 
interface 530 might also access CNC 550 by way of tuning core 520 and abstraction 
layer 510. Moreover, although not specifically shown in Fig. 13, an interface (e.g., an 
10 API) might also exist between user interface 530 and tuning core 520. 

According to one embodiment of the present invention, an optimum value of a 
parameter can be determined using an iterative technique in response to a request by a 
'P GUI, such as feedforward GUI 1 12. In an embodiment utilizing the aforementioned 

SI architecture, for example, a core layer might include the functionality for determining 

1 5 such a value in response to a request by a GUI. For example, the core layer might 
ih^ implement a finite state machine (FSM) for determining such a value, wherein the 

IB 

Ip^ GUI can issue a request that might be translated into stimulus conditions for the state 

:s: : 

!|^^ machine. 

An exemplary state machine 600 for servicing such requests is depicted in Fig. 
20 14. In the illustrated embodiment, state machine 600 is described utilizing a series of 
boxes and arrows. Each box represents a state and is potentially comprised of four 
areas. The top area in each box represents the name of the state represented by that 
box. The second area from the top represents an action to perform upon entering that 
state (e.g., when a system changes to that state). Meanwhile, the third area from the 
25 top represents an activity of that state (i.e., the things done while in that state). 

Finally, the fourth area from the top represents what is done upon exiting that state. 

Each arrow represents a state transition, where the head of the arrow identifies 
to what is being transitioned. The tail of the arrow represents from what is being 
transitioned. The text accompanying each arrow identifies the stimulus condition that 
30 causes the transition. 

Referring now to the exemplary embodiment illustrated in Fig. 14, iterative 
FSM 600 can include an idle state 610, a pre-run state 620, and a testing axis state 
630. Iterative FSM 600 might also include an alert state 660, which might be 
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advantageously included in an embodiment where it is desirable to handle error 
conditions that may arise. 

According to one such embodiment of the present invention, idle state 610 
could be a defauh state. For example, upon executing the FSM, idle state 610 is 
entered and state machine 600 waits for a request from a user interface, for example. 
According to one embodiment, while in idle state 610, state machine 600 polls for a 
control state (e.g., start test, in cycle). For example, a request such as start test may be 
generated by a user interface (e.g., through an interface to a core) in response to a user 
pressing a test button provided by the user interface. 

Upon identifying that a request has been made to start a test, the state machine 
transitions out of idle state and into pre-run state 620. In an exemplary embodiment, 
before transitioning into pre-run state 620, however, the state machine checks to see 
whether a test motion routine (e.g., an excitation part program) can be loaded (e.g., 
into an manual data interface or "MDI"). If the routine can be loaded, transitioning to 
pre-run state 620 can be completed. If the routine cannot be loaded (e.g., something 
else has possession of it), alert state 660 can be entered. Alert state 660 might also be 
entered if, during idle state 610, it is detected (e.g., by polling a control state) that the 
control is in cycle (which might mean that a part program is running). 

Upon entering prerun state 620, a test motion routine (referred to hereinafter 
by example as a part program, such as one used to cause the aforementioned chirp 
motion) is constructed. In an exemplary embodiment, such a part program will 
include loops that allow it to iterate according to techniques previously described. 
Such a part program can be generated based on an axis selected for the test (e.g., 
selected by the user) and/or other test setup parameters (e.g., start, stop, and duration). 

While in pre-run state 620, a control state can again be polled. For example, a 
control state can be polled to determine if a user has indicated that the test motion 
should start (which could be in response to a message to do the same that is generated 
while the state machine is in pre-nm state). Upon determining that the user desires 
the test motion to start (e.g., a detected control state of in cycle), state machine 600 
can transfer to testing axis state 630. 

Upon entering testing axis state 630, an initial value is determined for the 
parameter being optimized. In the example illustrated in Fig. 14, the parameter being 
optimized is shown as the time-shift parameter (identified in the figure as velocity 
feedforward lead adjustment or vff_lead_adj). In an exemplary embodiment, an 
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indication is also made that any optimum values deteraiined for other compensation 
parameters (e.g., feedforward compensation parameters) are also to be used in 
controlling the test motion. For example, upon entering testing axis state 630, 
feedforward compensation might be temporarily turned on and configured to use the 
values proposed for other feedforward parameters as previously described herein. If 
no new values for such parameters have yet been proposed, standard values (e.g., 
those existing in a database) can be used. 

Testing axis state 630 might include a nested state machine 670 that is entered 
while in testing axis state. Nested state machine 670 might include a waiting state 
680, a measuring state 690, an analyzing state 700, and a convergence test state 710. 
Thus, according to the illustrated embodiment, after entering testing axis state 630, 
waiting state 680 is entered. 

Upon entering waiting state 680, a configuration event can be issued. For 
example, a configuration event can be issued that tells the control (e.g., a real-time 
process on the control) to implement the aforementioned parameters. While in the 
waiting state 680, state machine 600 polls to determine whether the temporary 
configuration has completed (e.g., whether a real time process was able to actually go 
through the process of getting the new values). 

Once the temporary configuration has completed, state machine 600 can 
transition to measuring state 690. According to an exemplary embodiment, when a 
part program is executed, the program will be in cycle but will be suspended (e.g., by 
immediately going to a suspension state in the program). Motion is therefore not 
actuated until the part program is released from being suspended. Thus, according to 
one such embodiment, upon entering measuring state 690, the part program is 
released from a suspended state. For example, the part program might be released by 
incrementing a semaphore (e.g., the semaphore suspend). Accordingly, motion 
begins. 

While in measuring state 690, a determination is made as to whether the part 
program has reached a certain point in its execution that indicates that motion has 
completed. For example, state machine 600 might check for an indexed event. In the 
A2100 control of Siemens, one approach might include checking a sequence niraiber 
(e.g., polling seqnum). Moreover, in an exemplary embodiment, a suspend block is 
included in the part program after the motion block. According to such an 
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embodiment, after motion completes, the part program is still nmning, but is 
suspended. 

Upon determining that motion has completed, the state machine can transition 
to analyzing state 700. According to an exemplary embodiment, the part program 
includes commands to store data such as following error in the command position. 
While in analyzing state 700, state machine 600 attempts to load such data (e.g., via a 
data acquisition file). As it can take some amount of time after the motion is 
completed before such data is available, one embodiment of the present invention 
attempts to periodically load the data. 

According to one embodiment of the present invention, state machine 600 
might transition out of analyzing state 700 if it has been determined that there is 
something wrong with the acquired data. For example, in such a case, state machine 
600 can transition to alert state 660. In an exemplary embodiment, state machine 600 
might also transition out of analyzing state 700 if a time out condition occxirs (e.g., a 
certain period of time has elapsed since entering analyzing state, which might indicate 
that there might be something wrong with, for example, a file system). In such a case, 
state machine 600 might transition to alert state 660, for example. 

Referring, however, to a situation wherein no such error conditions exist, once 
the data is loaded, state machine 600 can cause it to be analyzed, such as to determine 
an RMS following error value for that execution. According to one embodiment, an 
indication of the completion of the analysis is generated and state machine 600 
transitions to convergence test state 710, Upon exiting analyzing state 700, however, 
a determination is made as to what is the current best value for the parameter being 
optimized. A potential value of the parameter can also be determined for analysis, 
such as through a technique based on the previously mentioned golden section search 
algorithm. 

At convergence test state 710, state machine 600 can check for convergence. 
For example, state machine 600 might attempt to identify, for example, two second 
best values of the parameter being optimized. In an exemplary embodiment, a 
determination can be made as to whether there has been a significant percentage 
change between the second best values and the current best vgdue. It can also be 
determined whether the values are so close together that there would be substantially 
no difference between using one over the others. If, for example, there has not been a 
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significant percentage change and/or the values are close enough together that there 
would be no significant difference, then convergence can be found. 

If convergence is not found, state machine 600 can transition back to waiting 
state 680 and the process iterated using the potential value of the parameter in the 
configuration of the control. For example, upon re-entering waiting state 680, a new 
configuration event can be issued to pick up the potential value of the parameter being 
optimized. The determination of the potential value can take place at a number of 
different states shown in exemplary state machine 600. For example, as previously 
discussed, the potential value can be determined in relation (e.g., while in or at exit) to 
analyzing state 700. In another embodiment, the potential value can be determined in 
relation (e.g., on entry, while in, or on exit) to convergence test state 710. 
Accordingly, nested state machine 670 can be utilized to iteratively determine an 
optimum value of the parameter. 

In an exemplary embodiment, a control state is also polled while in testing 
axis state 630. A control state can be polled, for example, to make sure that the part 
program is still in cycle. If the part program is not in cycle, the state machine can be 
transitioned to alert state 660, for example. 

Other error conditions might include, for example, exceeding a maximum 
number of iterations in nested state machine 670, According to one embodiment of 
the present invention, upon making such a determination, even though convergence 
has not been determined, the best value of the parameter might be identified, and an 
indication might be given that convergence was not determined and/or a reason as to 
why convergence was not determined (e.g., the maximum number of iterations was 
exceeded). 

In one embodiment of the present invention, the test can be cancelled. 
Accordingly, state machine 600 might include the ability to transition to a waiting for 
cycle complete (WaitFCC) state 650 in response to such an action. For example, 
WaitFCC state 650 can be used to wait for completion of program execution. 
According to one exemplary embodiment, for example, upon entering WaitFCC state 
650, semaphores can be released until a part program exits all of its loops. Moreover, 
if the test was cancelled after at least one potential value for the parameter being 
optimized was determined via nested state machine 670, that value can be identified 
for potential use (e.g., it might be identified in conjunction with an indication that 
convergence was not determined). 
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Referring, however, to a situation in which convergence was determined, state 
machine 600 could then transition to a next axis state 640. According to such an 
embodiment, if it is desired to test another axis, a value for the axis could be 
incremented and state machine 600 could again transition to testing axis state 630. If 
no other axis is to be tested, state machine 600 can transition to WaitFCC state 650. 
As previously stated, while in WaitFCC state 650, state machine 600 can wait for part 
program execution to complete. On part program completion, state machine 600 can 
transition back to idle state 610. 

The foregoing description of the preferred embodiments of the invention has 
been presented for purposes of illustration and description only. It is not intended to 
be exhaustive or to limit the invention to the precise form disclosed, and 
modifications and variations are possible in light of the above teachings. While a 
number of preferred equations and models have been described, it should be 
understood that variations and alternatives could be utilized without departing from 
the scope of the invention. For example, as discussed, the model disclosed could be 
modified to incorporate position dependent Coulomb friction, static friction, and 
machine compliance, and feedforward gains to compensate for these phenomena 
could be thereby calculated. As another example, the torque command measurements 
could be replaced by motor current measurements without departing form the scope of 
the invention. Furthermore, the concepts of the invention can be utilized to tune or 
estimate a number of parameters, such as, for example, the parameters Kp and Kj, 
which allow for an implementation of an analog interface between the CNC and 
servo. In addition, it should be understood that the invention can be used in a variety 
of motion control systems, and should not be limited to machine tool or CNC 
applications. 

Thus, it should be understood that the embodiments and examples have been 
chosen and described in order to illustrate the principals of the invention and its 
practical application to thereby enable one of ordinary skill in the art to best utilize the 
invention in various embodiments and with various modifications as are suited for 
particular uses contemplated. Accordingly, it is intended that the scope of the 
invention be defined by the claims appended hereto. 
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